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BY 
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Chairman:  Dr.  Gary  K.  Matthew 

Major  Department:  Mechanical  Engineering 

This  project  involves  a new  approach  to  teleoperations, 
utilizing  an  industrial  robot  as  a joystick  controller.  The 
concept  is  developed  based  on  the  fact  that  robot  systems  and 
force-reflecting  joystick  controllers  essentially  share  the 
same  technology  foundation.  This  concept  has  been  initiated 
with  a PUMA  600  robot  to  demonstrate  its  feasibility. 

In  this  experimental  system,  a commercially  available  six 
degree-of-freedom  force/torque  sensor  is  installed  at  the 
wrist  of  the  PUMA  600  robot  to  enhance  the  factory-supplied 
system  with  an  external  control  loop  in  order  to  accommodate 
the  operator's  application  of  forces  and  torques.  The 
Jacobian  matrix  associated  with  the  configuration  of  the  robot 
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is  used  to  transform  the  measured  wrenches  into  joint  torques. 
Several  trial  strategies,  which  use  the  resulting  joint 
torques  as  different  order  functions  of  joint  displacements, 
are  tested  to  convert  these  joint  torques  into  commands  so 
that  the  robotic  joystick  can  be  moved  accordingly. 

Experimental  results  showed  that,  with  the  current 
facilities,  the  PUMA  600  robot  has  the  capability  to  be  used 
as  a joystick.  An  experiment  which  reflects  artificial  forces 
from  the  remote  unit  to  the  robotic  joystick  subsystem  is  also 
conducted.  This  remotely  reflecting  force  can  be  well  sensed 
by  the  operator.  Some  observations  in  the  experiments  are 
discussed  so  that  a system  with  better  performance  can  be 
achieved. 


v 


CHAPTER  1 
INTRODUCTION 

1 . 1 Review  of  Teleoperator  Systems 

Teleoperation  indicates  direct  human  control  of  a remote 
manipulator.  The  objective  of  teleoperation  is  to  carry  out 
remotely  complicated  non-repeated  tasks  in  circumstances  where 
preprogramming  is  severely  limited. 

Teleoperation  began  with  the  handling  of  radioactive 
materials  in  nuclear  hotcells  in  the  late  1940s.  It  was  not 
until  1966  that  the  term  "teleoperator  system"  was  introduced 
for  the  first  time  by  Johnsen  [1].  Teleoperator  systems  were 
then  brought  to  the  areas  of  submersibles  and  space 
exploration. 

Roy  Goertz  and  his  colleagues  at  the  Argonne  National 
Laboratory  (ANL)  developed  the  first  mechanical  unilateral 
master-slave  teleoperator  system  for  handling  radioactive 
materials  in  1947  [2].  A year  later,  the  first  bilateral 
system  was  developed  based  on  mechanical  coupling.  This 
system  showed  that  force1  feedback  was  critical  if  the 
operator  was  reguired  to  perform  precise  tasks.  However,  the 
performance  of  the  mechanically  linked  system  was  found  to  be 

1 Throughout  this  work,  the  term  force  or  alternately 
wrench  has  a general  meaning  of  "force  and  torque." 
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limited  by  the  characteristics  of  the  transmission,  the 
increasingly  difficult  requirements  in  the  working 
environments,  and  the  distance  between  the  controller  and  the 
remote  site.  In  1954,  an  electrical  bilateral  master-slave 
manipulator  system  was  constructed  at  ANL  which  provided 
position  and  force  feedback.  Surprisingly,  since  the 
inception  of  this  electrical  bilateral  system,  no  other 
teleoperator  system  tested  has  been  able  to  perform  more 
effectively.  Although  the  bilateral  master-slave  system 
represents  the  demonstrated  state-of-the-art,  its  performance 
is  still  2 to  15  times  slower  than  that  of  humans,  dependent 
primarily  on  the  task  complexity  [3]. 

As  developments  proceeded,  flexibility  of  universal 
joystick  controllers,  or  indeed,  computer-aided  manual 
controllers,  became  a desired  feature.  The  concept  behind 
universal  joystick  controllers  is  that  the  controllers  can  be 
better  designed  to  interface  with  the  human  operator,  while 
remote  manipulators  can  be  optimized  to  meet  their  functional 
needs.  A universal  controller  is  able  to  locate  a remote 
manipulator  of  the  same  or  fewer  degrees  of  freedom  in  space. 
If  additional  degrees  of  freedom  exist  in  the  remote 
manipulator,  there  must,  of  course,  be  added  algorithms  to 
deal  with  the  redundant  degrees  of  freedom.  There  need  be  no 
geometrical  resemblance  between  the  master  controller  and  the 
remote  manipulator.  Kinematic  transformations,  performed  by 
computers,  are  required  to  coordinate  the  motions  between  the 
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control  device  (joystick  handgrip)  and  the  remote  manipulator 
(tool) . 

In  the  Center  for  Intelligent  Machines  and  Robotics 
(CIMAR)  at  the  University  of  Florida,  a nine-string  universal 
joystick  controller  and  its  computational  base  have  been 
designed  and  fabricated  [4,  5].  This  unilateral  joystick 
system  is  interfaced  to  a six-degree-of-freedom  (6-DOF)  MBA 
prototype  manipulator.  The  joystick  consists  of  a handgrip 
suspended  by  nine  strings  connected  to  spring-loaded 
potentiometers  and  a computer  interface.  The  potentiometers 
track  the  lengths  of  the  unwound  strings  and  use  these  lengths 
to  calculate  the  location  and  orientation  of  the  handgrip. 
Force  reflection  is  not  available  with  this  device.  Real-time 
computer  control  capabilities  have  also  been  implemented  on 
a PDP-11/03  computer  and  a PDP-11/23  computer  connected  by  a 
shared-memory  architecture.  By  simply  changing  the  software 
package,  one  is  able  to  use  the  controller  to  drive  a 
manipulator  with  completely  different  geometry.  If  the 
strings  tangle,  the  computed  location  and  orientation  will  be 
incorrect.  When  released,  the  handgrip  automatically  returns 
to  approximately  the  center  of  the  joystick  frame,  due  to  the 
loads  of  the  springs. 

A system  similar  to  the  nine-string  universal  joystick 
controller  is  under  development  at  the  University  of  Texas, 
Austin.  It  adds  a force-reflecting  capability.  Three 
gimbaled  pneumatic  cylinders  are  installed  to  apply  constant 
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forces  to  the  handgrip  and  nine  strings  are  connected  to  DC- 
motors  with  transducers  for  force  control  and  position 
measurement  [6]. 

Although  the  control  device  and  the  remote  manipulator 
normally  have  the  same  degrees  of  freedom,  this  is  not  a 
requirement.  A planar  4-DOF  force-reflecting  controller  was 
designed  and  constructed  at  CIMAR  to  control  the  horizontal 
planar  motion  of  the  6-DOF  MBA  manipulator  [7].  The  joystick 
consisted  of  four  links  serially  connected  by  revolute  joints. 
A cascading  arrangement  of  chains  and  sprockets  connected  each 
joint  to  a base-mounted  assembly  of  an  actuator,  a 
potentiometer,  and  torque  sensors.  Since  planar  motion 
requires  only  three  degrees  of  freedom,  the  redundant  degree 
of  freedom  was  used  either  to  optimize  some  criteria  such  as 
the  actuator  torques  or  to  configure  the  controller  so  that 
mathematical  singularities  were  avoided  [8,  9],  Substantial 
friction  and  backlash  exist  in  this  controller. 

Another  6-DOF  universal  position  joystick  with  the  shape 
of  scissors  was  designed  and  fabricated  in  association  with 
CIMAR.  This  joystick  has  a balanced  feature  [10].  It  was 
used  to  drive  the  MBA  manipulator  with  a real-time  computer 
implementation . 

A well-known  example  of  a 6-DOF  force-reflecting 
universal  controller  is  the  one  used  at  the  Jet  Propulsion 
Laboratory  (JPL)  [11].  This  device,  although  not  the  first 
attempt,  represents  the  first  fully  developed  6-DOF  force- 
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reflecting  universal  joystick  system.  The  joystick  is  based 
on  a spherical  geometry.  It  features  approximately  a one- 
cubic-foot  workspace  and  has  a counterbalanced  structure. 

Hirzinger  discussed  about  how  a force  transducer  ball 
could  be  used  to  drive  a robot  for  teaching  [12,  13,  14,  15, 
16].  The  transducer  ball  could  be  attached  to  the  gripper 
working  with  another  force/torque  sensor  and  thereby  allow  the 
operator  to  move  the  robot.  It  could  also  be  mounted  on  a 
desk  and  used  as  an  isometric  rate  joystick. 
Subjective/ objective  evaluations  of  the  device  were  not 
presented  in  any  of  the  above  references. 

1 • 2 Classification  of  Teleoperator  Systems 

A teleoperator  system  consists  of  three  principal 
elements:  the  control  unit.  the  remote  unit.  and  the 
communication  channel.  The  remote  unit  generally  consists  of 
a mechanical  arm  with  an  end-effector  to  grasp  objects.  The 
control  unit  must  contain,  at  a minimum,  a device  for  the 
operator  to  input  instructions  for  the  desired  activities  of 
the  remote  unit.  The  communication  channel  allows  required 
information  to  be  passed  between  the  control  unit  and  the 
remote  unit  in  forms  compatible  to  both  of  them. 

The  human  operator  in  the  teleoperator  system  provides 
the  highest  level  of  decision-making  capability.  The  human 
operator  must  be  aware  of  the  ongoing  task  of  the  remote 
manipulator  and  be  able  to  command  the  remote  manipulator 
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effectively.  Because  of  the  completely  different  natures 
between  the  human  and  the  manipulator,  an  effective  control 
mediator  is  needed  to  augment  the  human  operator.  This 
mediator  is  called  the  man-machine  interface  and  consists  of 
the  control  unit  and  part  of  the  communication  channel. 
Intelligent  sensing  capabilities  can  be  integrated  into  the 
man-machine  interface  to  enhance  its  performance. 

The  types  of  man-machine  interfaces  used  in  teleoperator 
systems  can  be  roughly  categorized  as  follows,  although 
combinations  of  them  do  occur: 

1)  Simple  function  controllers  are  usually  compact,  cheap, 
and  thereby  work  with  limited  functions.  They  are  only 
used  to  control  a single  joint  or  a single  degree  of 
freedom.  Switches  and  potentiometers  are  typical 
examples  of  this  type  of  controller.  Switch  controllers 
generally  consist  of  a spring-centered,  three-position, 
discrete  action  device.  Potentiometers  are  commonly  used 
to  adjust  signal  gains.  To  control  a manipulator  with 
combinations  of  single  degree-of-freedom  movements,  the 
difficulty  varies  with  the  joint  arrangement  and  the 
desired  path  of  motion;  for  example,  a prismatic  joint 
is  easily  moved  in  a straight  line  motion  along  its  axis. 
On  the  other  hand,  an  arbitrary  straight  path  is  not 
easily  generated  by  a revolute  manipulator. 
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2)  Master-slave  controllers  are  either  a geometrical 
duplicate  or  a scaled  replica  of  the  remote  manipulator. 
The  one-to-one  correspondence  of  this  type  of  controller 
with  its  slave  manipulator  arguably  reduces  the 
operator's  workload.  It  also  allows  the  system  to  be 
implemented  without  using  a computation  base.  Force 
reflection  from  the  remote  manipulator  is  sometimes 
incorporated  in  the  master-slave  system,  which  enhances 
the  interface  transparency.  Commercially  available 
bilateral  joysticks  are  often  master-slave  controllers. 

3)  Anthropomorphic  controllers  are  very  much  like  other 

types  of  master-slave  controllers,  except  that  it  has  the 
configuration  of  the  human  arm.  It  utilizes  natural 
human  motion  to  control  the  remote  manipulator,  which 
results  in  a reduced  learning  period  of  time  for  the 
operator.  When  properly  designed,  it  can  control  as  many 
as  seven  independent  degrees  of  freedom:  3 for  the 

shoulder,  1 for  the  elbow,  and  3 for  the  wrist.  Of 
course,  this  type  of  controller  is  restricted  by  the 
physical  dimensions  of  the  human  arm. 

4)  Universal  joystick  controllers  are  able  to  control  the 
remote  manipulator  even  when  there  is  no  geometrical 
analogy  between  them.  A computation  base  is  mandatory 
in  order  to  interface  the  controller  with  a manipulator 
arm.  Force  reflection  from  the  remote  manipulator  can 
be  incorporated.  Some  universal  joysticks  are  classified 


8 


according  to  their  particular  features.  An  isotonic 
joystick  is  a position-operated,  fixed-force  (isotonic) 
device  used  to  control  two  or  more  degrees  of  freedom 
with  a single  hand  within  a limited  operational  volume. 
An  isometric  joystick  is  a force-operated,  minimal- 
displacement  (isometric)  device  used  to  control  two  or 
more  degrees  of  freedom  with  a single  hand.  The  output 
of  the  controller  corresponds  directly  to  the  forces 
applied  by  the  operator  and  drops  to  zero  unless  manual 
force  is  maintained.  A proportional  joystick  is  a 
single-handed,  two  or  more  degree-of-freedom  device  with 
a limited  operational  volume  in  which  the  displacement 
is  in  proportion  to  the  force  applied  by  the  operator. 

As  far  as  the  flow  of  information  is  concerned, 
teleoperator  systems  can  also  be  distinguished  as  unilateral 
or  bilateral  systems.  In  unilateral  systems,  position 
commands  are  fed  from  the  master  to  the  slave,  with  no  reverse 
information  flow  through  the  communication  channel.  The 
operator  is  obliged  to  use  visual  sense  as  well  as  experience 
to  assess  the  results  of  his  commands.  In  bilateral  systems, 
in  addition  to  the  position  information  being  sent  from  the 
master  to  the  slave,  applied  loads  on  the  slave  are  reflected 
to  the  master  device.  Bejczy  and  Salisbury  found  that  task 
completion  times  were  often  reduced  by  40%  when  the  operator 
was  given  force  feedback  information  [11]. 
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Based  on  the  control  strategy,  teleoperator  systems  can 
be  classified  as  direct  rate  control,  resolved  motion  rate 
control,  direct  position  control,  and  resolved  motion  position 
control . 

Direct  rate  control  represents  an  elementary  type  of 
controller  which  controls  the  velocities  of  actuators  of  the 
manipulator  with  a one-to-one  correspondence.  No 
computational  interface  is  required  since  rate  controllers  do 
not  address  the  coordinated  motion  of  the  manipulator  end- 
effector.  Force  feedback  cannot  be  accommodated.  Hence,  they 
are  much  less  desirable  as  a transparent  interface  device. 

The  next  advancement  in  teleoperator  systems  is  resolved 
motion  rate  control,  first  described  by  Whitney  during  the 
late  1960s  [17].  Differing  from  direct  rate  control  where 
the  operator  controls  the  velocities  of  particular  joints  of 
the  manipulator,  resolved  motion  rate  control  calculates  the 
joint  velocities  of  the  actuators  so  that  the  end-effector 
moves  along  a trajectory  at  a given  velocity  with  respect  to 
the  task  environment.  Jacobian  transformation  is  a commonly 
used  technique.  Force  feedback  capability  is  limited  or 
nonexistent  in  resolved  motion  rate  control  systems. 

A common  weakness  with  all  the  rate  controllers  is  that 
positioning  of  the  end-effector  in  space  is  indirect  due  to 
the  velocity  control  strategy.  The  operator  must  mentally 
integrate  the  velocity  and  try  to  command  the  manipulator  to 
reach  a desired  position.  In  general,  rate  controllers  cannot 
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effectively  command  the  coordinated  motion  of  a slave  device 
in  space.  Rate  control  is  10  to  50  times  slower  than  the 
master-slave  position  control  for  some  tasks  [3]. 

Direct  position  control  is  usually  used  by  a replica 
device  of  the  remote  manipulator.  Resolved  motion  position 
control  is  a strategy  used  by  the  universal  controller. 

A comparison  between  the  performance  of  a rate  controller 
and  that  of  a replica  master  controller  with  force  feedback 
has  been  documented  by  Wilt  et  al.  [18].  Different  control 
modes  were  implemented  using  the  same  remote  manipulator  but 
with  the  two  different  controllers.  The  results  of  task 
completion  time  with  tasks  of  varying  difficulty  showed  that 
bilateral  control  had  a distinct  advantage  over  resolved 
motion  rate  control. 

Brooks  concludes  that  position  control  is  the  best  for 
fine  motions  where  accuracy  is  of  paramount  importance,  while 
rate  control  is  the  best  for  large  gross  transfer  motion  [19]. 
Rate  control  has  the  disadvantage  of  loss  of  coordinate 
reference  when  the  operator  attempts  to  command  an  angular 
velocity  with  non-zero  components  along  more  than  one  of  the 
reference  axes. 

A more  recently  developed  term  is  supervisory  control 
which,  in  general,  allows  the  operator  to  specify  some  of  the 
desired  tasks  symbolically.  The  computer  interprets  the 
issued  symbolic  commands  to  instruct  a remote  device.  This 
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type  of  man-machine  interface  results  in  a hybrid  between  a 
teleoperator  system  and  an  autonomous  robot. 

The  communication  channels  between  the  control  unit  and 
the  remote  unit  can  also  be  classified  into  three  types: 

1)  pure  mechanical  transmission, 

2)  electrical  transmission,  and 

3)  computer-aided  teleoperation. 

Mechanical  teleoperator  systems  are  the  earliest 
development  and  are  still  used  in  the  majority  of  current 
nuclear  installations.  The  transmissions  can  be  tapes, 
shafts,  cables,  etc.  Friction,  backlash  and  elastic 
deflections  are  undesirable  features  of  these  systems.  Master 
controllers  can  not  be  far  away  from  slave  manipulators  with 
mechanical  transmissions.  Force  feedback  can  be  incorporated, 
however. 

Electrical  teleoperator  systems  allow  greater  flexibility 
in  system  layout  and  better  versatility  in  control.  One-to- 
one  correspondence  is  kept  between  the  master  device  and  the 
remote  manipulator.  Both  unilateral  and  bilateral  systems 
exist. 

When  computer-aided  teleoperation  is  used  as  the 
communication  channel,  the  one-to-one  correspondence  between 
the  master  device  and  the  remote  manipulator  is  no  longer 
significant  and  is  replaced  by  transformations  between  the 
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two  operational  spaces.  The  system  can  be  made  more  flexible 
at  the  cost  of  computational  delay  and  data  communication 
delay.  It  is  realized  that  the  time  delay  in  a computer-aided 
teleoperator  system  is  critical  to  system  stability. 

As  of  today,  neither  a communication  architecture  nor  a 
control  strategy  exists  which  can  eliminate  the  time  delay. 
The  direction  of  research  in  remote  manipulators  is 
approaching  modular  designs  so  the  components  can  easily  be 
replaced  at  a remote  site  [20].  As  far  as  the  control  unit 
is  concerned,  there  are  many  different  models,  and  several 
authors  [3,  21,  22]  give  extensive  reviews  about  the  evolution 
of  teleoperator  systems. 

1 . 3 The  Robot  as  a Teleoperator  Controller 

Joystick  technology,  being  used  as  a man-machine 
interface  in  teleoperation,  attempts  to  utilize  machine 
intelligence  to  augment  the  operator  and  thus  reduce  his 
efforts  during  operation.  Since  the  human  being  and  the 
manipulator  are  by  nature  quite  different,  it  is  the  function 
of  the  joystick  to  transfer  necessary  information  between 
these  two  entities  in  a way  suitable  to  both.  The  common 
approach  to  joystick  design  is  to  follow  some  design 
guidelines  which  are  obtained  from  experience  and  to  make  the 
joystick  meet  the  performance  requirements.  Chances  are  that 
some  conflicts  among  different  performance  requirements  arise, 
and  thus  compromises  must  be  made  in  the  design  process. 
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The  philosophy  introduced  here  is  that,  instead  of 
designing  a whole  new  edition  of  a joystick,  a robot  system 
is  used  in  place  of  a joystick  controller,  or  even  a force- 
reflecting  joystick.  Based  on  this  idea,  the  technologies  of 
robot  design  and  joystick  design  are  merged.  In  the  field  of 
joystick  research,  it  is  also  possible  to  set  up  a testbed 
for  different  types  of  joysticks  as  long  as  the  same  types  of 
robot  systems  exist.  These  testing  results  can  be  helpful  for 
those  people  who  design  joysticks  with  selected  criteria. 
With  the  robotic  joystick  system,  some  of  the  important 
requirements  for  joystick  design  are  internally  taken  care  of 
by  the  original  robot  system. 

This  research  specifically  intends  to  utilize  an 
industrial  robot,  a PUMA  600,  as  a controller  device  for 
teleoperations.  A wrist  force/torque  sensor  is  installed  to 
sense  the  operator's  application  of  wrenches.  These  sensed 
wrenches  are  further  transformed  into  joint  torques  via 
Jacobian  transpose  mapping  in  real  time.  A suitable  control 
algorithm  is  selected  amongst  several  choices  so  that  the  PUMA 
robot  is  able  to  perform  effectively  as  a joystick  controller. 
Moreover,  an  experiment  using  the  PUMA-robot  joystick 
subsystem  (PRJS)  as  a bilateral  system  is  conducted.  A remote 
computer,  which  simulates  the  reflecting  joint  torques,  is 
integrated  with  the  PRJS  to  demonstrate  its  capability  as  a 
bilateral  device.  In  subsequent  chapters,  we  detail  the 
development  of  the  PRJS  and  an  experimental  implementation. 
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Chapter  2 gives  the  necessary  background  of  the 
characteristics  of  the  PUMA  600  robot  system  so  that  it  can 
be  used  as  a joystick  after  some  modifications.  Also 
discussed  is  a primitive  approach  to  the  forward  displacement 
analysis  of  the  PUMA  600  robot,  which  fits  the  factory- 
supplied  measurement  system. 

Chapter  3 introduces  the  PRJS.  A brief  review  of  force 
control  in  robotics  is  conducted.  The  Jacobian  matrix  and  the 
transformations  which  integrate  the  sensed  wrenches  into  the 
system  are  conducted  based  on  a practical  implementation  of 
screw  theory.  System  dynamics  are  analyzed  to  indicate 
potentially  acceptable  systems. 

Chapter  4 explores  different  algorithms  for  the  PRJS. 
The  performance  results  of  stable  algorithms  are  further 
analyzed.  To  investigate  force-reflection  on  the  device, 
artificial  force  information  is  brought  into  the  PRJS  from  a 
remote  computer,  which  demonstrates  the  potential  for  using 
an  industrial  robot  as  a force-reflecting  joystick. 

Chapter  5 concludes  this  project  with  a comparison  of 
advantages  and  disadvantages  of  a robotic  joystick  subsystem. 
Some  ideas  for  future  development  of  robotic  joystick 
subsystem  are  also  discussed. 


CHAPTER  2 

THE  PUMA  600  ROBOT 

Industrial  robots  are  designed  to  satisfy  kinematic 
specifications.  The  inertial  parameters,  such  as  the  location 
of  center  of  mass  and  the  moment  of  inertia  of  each  link,  are 
incidentally  attributed  and  are  usually  not  known  even  to  the 
manufacturers  of  the  robots.  Industrial  robots  are  also 
characterized  by  high  gear  ratios  and  substantial  friction. 
As  a result,  most  industrial  robots  are  designed  with  simple 
approaches  by  utilizing  independent- j oint  position-integral- 
derivative  (PID)  controllers  with  the  sacrifice  of  faster 
speed  and  better  payload  handling  capability. 

In  the  CIMAR  laboratory,  a PUMA  600  robot  is  available 
for  this  project.  It  offers  six  degrees  of  freedom  which  can 
span  the  translational  and  rotational  coordinates  in  3-space. 
Although  position  scaling  and  re-referencing  allow  the 
operational  volume  of  a joystick  to  be  sized  to  the  reach  of 
a human  so  that  the  joystick  can  drive  a slave  manipulator 
throughout  its  full  workspace,  the  concept  of  synchronized 
operation  prefers  the  dexterity  of  the  joystick  to  be  as  great 
as  that  of  the  controlled  manipulator. 

In  order  for  an  industrial  robot  to  serve  as  a research 
tool,  it  is  necessary  to  modify  the  control  system  so  that  the 
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robot  can  be  driven  by  a computer  using  a standard  computer 
language.  Different  methods  can  make  this  possible.  In  this 
research,  the  existing  servo  of  the  PUMA  robot  is  adopted. 
Most  of  the  originally  design  features  of  the  PUMA  system  are 
preserved,  except  for  the  DEC-11/02  CPU  and  some  components 
which  are  connected  directly  to  the  CPU  [23]. 

In  this  chapter,  the  factory-supplied  PUMA  600  robot 
system  is  briefly  described.  Communication  between  the  PUMA 
controller  and  a personal  computer  is  briefly  explained. 
Since  the  PUMA  robot  is  to  be  used  as  a joystick  device, 
location  and  orientation  of  its  end-effector  must  be 
calculated  via  a forward  displacement  analysis. 

2 . 1 System  Characteristics 

The  PUMA  robot  is  designed  to  be  a Programmable  Universal 
Machine  for  Assembly.  The  PUMA  600  robot  has  six  serially 
connected  revolute  joints  and  a wrist-mounted  gripper.  It  can 
handle  a payload  only  up  to  five  pounds.  The  kinematic 
parameters  of  the  PUMA  600  robot  are  shown  in  Figure  2.1. 

The  PUMA  600  robot  is  an  independent- j oint  position- 
controlled  device  with  pre-specif ied  PID  control  gains  at  the 
hardware  level.  It  is  not  normally  backdrivable.  The 
actuator  of  each  joint  incorporates  a pair  of  position 
sensors,  a potentiometer  and  a 16-bit  optical  incremental 
encoder.  The  coarse-resolution  potentiometers  are  used  to 
calibrate  the  power-up  joint  positions  of  the  robot.  The 
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Figure  2.1  Schematic  Diagram  of  PUMA  600  Robot 
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fine-resolution  incremental  encoders  are  used  with  the  servos 
to  accurately  control  the  joints.  Accuracy  and  repeatability 
of  the  PUMA  600  robot  are  both  claimed  by  the  manufacturer  to 
be  within  0.1  mm  [24].  The  reason  for  using  two  position 
measurement  systems  is  simply  because  the  price  of 
potentiometers  and  incremental  encoders  is  less  expensive  than 
that  of  absolute  encoders  with  the  same  resolution. 

Since  potentiometers  are  absolute  devices,  when  power  is 
turned  on  and  a voltage  is  applied  to  them,  output  voltages 
can  be  measured  from  their  wipers  to  indicate  joint  angles  of 
the  robot.  Potentiometers  are  connected  to  the  8 -bit  analog- 
to-digital  converters  providing  approximate  joint  angles  (to 
the  order  of  2 to  3 degrees) . The  16-bit  incremental  encoders 
measure  joint  angles  more  precisely  (to  the  order  of  0.05 
degrees) . Whenever  power  is  shut  down,  the  robot  system  loses 
track  of  the  measurement  of  joint  angles  due  to  the  use  of  the 
incremental  encoders.  It  is  necessary  to  settle  the 
measurement  references  of  the  encoders  with  the  help  of 
potentiometers  so  that  the  PUMA  robot  is  precisely  controlled. 
Initialization  and  calibration  routines  for  the  PUMA  600  robot 
are  described  in  Shieh  [23]  along  with  the  system  parameters 
used  by  the  VAL  operating  system. 

The  PUMA  system  was  designed  in  the  early  1970s.  As  a 
result,  it  is  sometimes  not  powerful  or  flexible  enough  for 
today's  demands.  In  particular,  it  supplies  only  very  limited 
communication  with  the  outside  world.  The  PUMA  system,  either 
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with  VAL  or  its  supplementary  VAL-II,  offers  only  RS-232C 
serial  communication  lines  with  the  transmission  rate  not 
higher  than  9600  baud.  The  situation  is  made  worse  by  the 
fact  that  the  signals  passed  through  the  serial  line  must  be 
synchronized  with  the  control  cycle  and  be  compatible  with 
the  formats  of  the  VAL  system,  which  is  not  always  economical. 

The  components  in  the  PUMA  600  controller  are  made  up  of 
Unimation  components  which  include  an  arm  interface  board 
(AIB) , 6 servo  boards,  and  6 power  amplifiers,  and  Digital 
Equipment  Corporation  (DEC)  components  which  include  an  LSI- 
11/02  CPU,  2K  EPROM,  4K  RAM,  a serial  interface  to  a terminal, 
and  a DRV-11  parallel  interface  to  the  AIB.  The  basic  layout 
of  the  controller  is  shown  in  Figure  2.2.  The  EPROM  is  the 
place  where  VAL  codes  and  constants  are  stored.  The  factory- 
supplied  PUMA  system  needs  to  be  taught  by  a teach  pendant 
working  together  with  the  VAL  software.  There  is  no  way  to 
incorporate  force  information  into  the  system. 

In  order  to  communicate  with  the  servo  of  the  PUMA  robot, 
the  communication  protocols  used  by  the  VAL  system  must  be 
emulated.  The  communication  protocols  are  given  in  Table  2.1, 
which  have  been  verified  with  the  help  of  a logic  analyzer  and 
the  on-line  debug  tool  (ODT)  of  the  PDP  computer. 

The  joint  microprocessor  commands  of  the  VAL  system  are 
encoded  in  the  format  of  Table  2.2,  where  bits  0-2  are  used 
for  joint  selection  and  bits  3-6  are  used  for  different 
command  modes.  The  command  00X8  represents  the  position  mode 
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Figure  2.2  Layout  of  the  PUMA  600  Controller 
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Table  2.1  Communication  Protocols  with  PUMA  Joint  Microprocessors 


WRITE: 

Operations 


Functions 


CSRO  «==  0 
OUTREG  ■*— — Command 
CSRO  «=  1 
OUTREG  Data 


Clear  CSRO  bit 
Send  out  the  command 
Set  CSRO  bit 
Write  data  out 


READ: 


Operations 


Functions 


CSRO  0 

OUTBUF  « Command 

CSRO  «=  1 

Data  «=  INREG 


Clear  CSRO  bit 
Send  out  the  command 
Set  CSRO  bit 
Read  data  in 


Table  2.2  Bit-Formats  of  Microprocessor  Commands  of  PUMA  robot 


15 

Not  Used 

8 

7 

6 

3 

2 

0 

Sequential  bit 


Command  mode  bits 


0000 

Position  mode 

1100 

Read  encoder 

Joint  selection  bits 


000 

Command  joint  1 

001 

Command  joint  2 

010 

Command  joint  3 

Oil 

Command  joint  4 

100 

Command  joint  5 

101 

Command  joint  6 
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which  can  drive  joint  X-l  to  an  assigned  joint  position.  The 
command  14Xg  is  used  to  read  the  encoder  code  of  joint  X-l. 
The  subscript  following  the  number  denotes  the  number  base 
system;  for  example,  "8"  indicates  an  octal  number.  Encoder 
codes  can  be  further  converted  into  joint  angles. 

As  mentioned,  the  PUMA  robot  is  essentially  controlled 
with  an  "independent- joint"  strategy.  The  VAL  commands,  after 
interpretation  by  the  operating  system,  are  sent  to  joint 
microprocessors  through  a DRV-11  parallel  interface  and  an  AIB 
every  28  msec.  The  correspondingly  commanded  joint  positions 
are  then  interpolated  into  32  equal  increments  to  servo  the 
joint  actuators  every  0.875  msec.  It  is  very  important  for 
the  control  codes  to  complete  execution  within  the  28  msec 
cycle  time  so  that  the  robot  can  move  smoothly. 

2 . 2 Forward  Displacement  Analysis 

With  a universal  joystick,  the  geometric  relationship 
between  the  joystick  and  the  slave  manipulator  does  not 
normally  keep  a one-to-one  correspondence.  Therefore,  a 
forward  displacement  analysis  of  the  joystick  and  a reverse 
displacement  analysis  of  the  slave  manipulator  are  required 
in  order  to  coordinate  these  two  subsystems.  To  use  the  PUMA 
robot  as  a joystick,  a forward  displacement  analysis  is 
carried  out  for  the  completion  of  the  work. 

Serial  robots  are  good  examples  for  studying  relative 
coordinate  systems.  Each  link  of  the  robot  is  usually 


23 


considered  to  have  an  attached  local  coordinate  system. 
Encoders  are  associated  with  each  of  the  joints.  The  joint 
angles  can  be  found  from  the  encoder  readings.  Applying  the 
joint  angles  in  a forward  displacement  analysis,  location  and 
orientation  of  the  end-effector  of  the  robot  can  be 
determined.  The  essence  of  the  forward  displacement  analysis 
is  to  transform  the  coordinates  of  the  end-effector  associated 
with  its  local  coordinate  system  into  the  base  coordinate 
system.  A systematic  approach  to  implement  this  analysis  is 
to  line  up  the  local  transformation  matrices  between  the  base 
coordinate  system  and  the  end-effector  coordinate  system. 

Although  the  forward  displacement  analysis  is  not 
difficult  with  any  set  of  local  coordinate  systems,  for 
practical  reasons  in  this  particular  work,  it  is  convenient 
to  have  the  local  coordinate  system  of  each  joint  aligned  with 
each  axis  of  the  factory-supplied  PUMA  600  robot  so  that  the 
measured  joint  angles  can  be  utilized  without  further 
modifications . 

Consider  the  situation  depicted  in  Figure  2.3,  where  a 
point  p is  located  in  a space  characterized  by  two  different 
Cartesian  coordinate  systems.  Suppose  that  the  location  of 
point  p corresponding  to  coordinate  system  1,  denoted  by  Pl; 
and  the  displacement  from  coordinate  0 to  coordinate  system 
1,  denoted  by  D = (d^01  dy01  dz01)T,  are  both  known.  The  location 
of  point  p relative  to  coordinate  system  0,  given  as  P,,,  can 
then  be  obtained  by  applying  the  concept  of  vector  projection. 
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Figure  2.3  Relative  Coordinate  Systems  of  a Point 
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The  transformation  between  Pt  and  P„  can  be  expressed  by  a 
homogeneous  transformation  matrix  as 


£0 


1 


(2.1) 


where 


o 


T1 


[R]  D 
[0]  1 


and  [0]  is  a 1x3  null  array,  D is  regarded  as  a translational 
vector  between  two  coordinate  systems,  and  [R]  is  a 3x3 
rotation  matrix  from  coordinate  system  1 to  coordinate  system 
0,  given  as 


[R] 


ii -io 

irio 

Krio 

irio 

irio 

Krio 

Arfco 

ii-Jso 

Ki-Ko 

Each  column  of  [R]  represents  the  perpendicular  projection  of 
a unit  vector  in  coordinate  system  1 onto  coordinate  system 
0.  [R]  is  an  orthonormal  matrix. 

Following  this  convention,  the  local  transformation 
matrix  from  coordinate  frame  i into  coordinate  frame  i-1  can 
be  expressed  as 
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i • ii-i 

ii-ii-i 

• 1m 

dx  / i-li 

i ii  i 

ii-ii-i 

& Oi  l 

> i-li 

ii-ki-1 

i -Ki-i 

ki  - Hu 

dz  / i-li 

0 

0 

0 

1 

The  forward  transformation  matrix  between  the  end-effector 
coordinate  system  and  the  base  coordinate  system  for  a 6-DOF 
serial  robot  can  be  obtained  by 


T 


oT^T2  2T33T44T5  jT6  . 


(2.3) 


Applying  the  kinematic  parameters  in  Figure  2.1,  the  local 
transformation  matrices  are  obtained  as  shown  with 
illustrations  in  Table  2.3.  The  elements  of  transformation 
matrix  T for  the  PUMA  600  robot  are  obtained  as 


nx  sx  ax  Px 

Hy  sy  ay  Py 

nz  sz  az  pz 

0 0 0 1 


n s 

0 0 


a E 
0 1 


(2.4) 


where  n,  s,  and  a are  unit  vectors  representing  the 
orientation  of  the  gripper,  and  p specifies  the  location  of 
the  origin  of  the  gripper  coordinate  system  in  the  base 
coordinate  system,  as  shown  in  Figure  2.4,  with 
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Table  2.3 
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Local  Transformation  Matrices  of  PUMA  600  Robot 
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Figure  2.4  Tool  Coordinates  of  the  End-Effector 
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n,  = C1[C23(C4C5C<-S4S<)-S23S3C6]-S1(S4CsC<+C4S6) 
ny  = Sj  [C23  (C4C5C6-S4S6)  -S^CJ+Ci  (S4C5C6+C4S6) 
nz  = “ [ S23  (C4C5C6-S4S6)  +C23S5C6] 
sx  = Cj  [ — C23  (C4C5S6+S4C6)  +S23S5S6]  +Sj  (S4C5S6— C4C6) 
sy  = Sj  [ — C23  ( C4C5S6+S4C6)  +S23S5S6]  ~Cj  (S4C5S6— C4C6) 

Sz  = ^23  (C4C5S6+S4C6)  ’*"^23®5®6 
ax  = Cj  (C23C4Sj+S23C5)  — SjS4Sj 
ay  = Sj  ( C23C4S5+S23C5) +C1S4S5 
az  = — S23C4S5+C23C5 

Px  = L ( CJC23C4S5+CJS23CJ  — SjS4S5) +HCJS23+GCJC2- FSj 
Py  = L (S1C23C4S5+S1S23C5+CjS4S5)  +HSJS23+GSJS2+FCJ 
Pz  = L ( — S23C4S5+C23C5  ) +HC23-GS2 . 

Note  that  only  two  among  three  orientation  vectors,  n,  s,  and 
a,  are  required.  If  necessary,  the  third  can  be  obtained  by 
a cross  product  of  the  other  two  vectors,  for  example,  n = s 


x a. 


CHAPTER  3 

SYSTEM  DEVELOPMENT  AND  CONCEPTUAL  DESIGN 

In  this  project,  the  operator  grasps  the  handgrip  which 
is  installed  on  the  end-effector  of  the  robot  and  desires  that 
the  robot  respond  to  the  instructions  of  his  hand.  A wrist 
force/torque  sensor  is  used  to  sense  the  operator's 
application  of  wrenches.  These  sensed  wrenches  are  further 
transformed  into  joint  torques.  A series  of  fundamental  trial 
strategies  is  tested  to  control  the  PRJS. 

Force  information  plays  a significant  role  in  this  work. 
To  clarify  control  strategies  of  robots,  a brief  review  of 
force  control  is  conducted  in  this  chapter.  The  Jacobian 
transformation,  which  plays  an  important  role  in  the  PRJS, 
will  be  introduced  in  a practical  sense.  Also  introduced  is 
an  analysis  for  the  system  stability  which  is  helpful  in  the 
conceptual  design  stage. 

3 . 1 Review  of  Force-Sensed  Control  of  Robots 

Force-controlled  manipulators  have  been  continually 
investigated  in  the  literature  [25,  26,  27,  28,  29,  30,  31, 
32,  33].  Although  numerous  simulation  results  have  been 
presented,  there  have  been  few  published  reports  on  the 
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experimental  implementation  of  this  type  of  controller.  An 
exception  to  this  statement  is  in  the  research  of  force- 
controlled  direct  drive  arms.  These  have  been  recognized  to 
be  good  only  for  testing  control  strategies  as  a result  of 
their  dominant  inertia  effects.  In  order  to  experimentally 
implement  the  force-controlled  strategies  for  a robot,  an 
appropriate  robotic  system  and  an  appropriate  on-line 
computation  facility  are  needed. 

Stemming  from  teleoperation,  Inoue's  selective  joint 
torque  control  was  an  early  development  of  a force-controlled 
manipulator  which  separated  joints  into  position-controlled 
and  torque-controlled  ones  [25].  This  concept  was  generalized 
by  Mason  as  the  hybrid  control  theory  based  on  the  task 
geometry  [26],  and  further  experimentally  verified  by  Raibert 
and  Craig  on  two  degrees  of  freedom  for  the  6-DOF  Stanford 
robot  [27].  The  concept  of  hybrid  control  proposed  software 
filters,  which  were  formulated  according  to  the  constraints 
of  task  geometry,  to  distinguish  between  position-controlled 
and  torque-controlled  joints.  In  Raibert  and  Craig's 
experiment,  the  position  commands  were  explicitly  transformed 
into  the  joint  torques  via  a specified  stiffness  matrix.  They 
did  report  instability  problems  as  observed  in  the  experiment. 

The  control  torques  to  drive  each  joint  of  a manipulator 
can  be  computed  based  on  a suitable  dynamic  model,  which  is 
often  referred  to  as  computed-torque  control.  Lagrange 
formulation  and  Newton-Euler  formulation  are  used  to  compute 


32 


the  control  torques  [28,  29].  A feedback  control  scheme  is 
essential  in  order  to  compensate  for  the  unavoidable  modeling 
errors.  Owing  to  the  complexity  of  the  dynamic  model  of  a 
robot,  it  is  difficult  to  implement  a real-time  computed- 
torque  control  for  a manipulator. 

Khatib's  COSMOS  [30]  system  carries  out  the  dynamically 
decoupled  control  torques  in  the  so-called  operational  space, 
which  is  indeed  a combination  of  position  space  and  wrench 
space.  Because  of  heavy  computing  operations,  the  software 
is  executed  in  the  NYMPH  computer  system,  which  includes  five 
NSC  32016  processors  and  one  MC  68010  processor  connected  with 
an  Intel  multibus. 

Another  approach  is  to  determine  the  control  torques  by 
means  of  gain  matrices  with  feedback  position  or  velocity 
information.  Whitney's  damping  control  [31],  Salisbury's 
stiffness  control  [32],  and  Hogan's  impedance  control  [34]  all 
fall  into  this  category. 

Differing  from  force  control,  most  industrial  robots  are 
controlled  with  either  position  commands  or  velocity  commands 
due  to  their  easy  implementation.  In  recent  years,  an 
interesting  concept  of  the  inner/outer  control  loop 
configuration,  which  can  take  advantage  of  the  existing 
factory-supplied  systems,  has  drawn  more  attention.  With  this 
configuration,  the  inner  control  loop  can  reject  internal 
disturbances  caused  by  the  actuator  since  it  is  closed  on  the 
colocated  joint  sensor.  The  outer  control  loop  can  reject 
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the  external  disturbances  originating  from  the  interaction 
wrenches  between  the  end-effector  and  the  environment  since 
it  is  closed  on  the  force/torque  sensor.  Simons  and  Van 
Brussel  in  [35]  and  Maples  and  Becker  in  [36]  all  discussed 
the  same  concept. 

The  stability  issue,  which  has  been  recognized  recently 
[31,  37,  38,  39,  40,  41,  42,  43,  44,  45],  is  critical  for 
force-controlled  manipulators.  Only  limited  efforts  have  been 
devoted  to  investigate  the  real  causes  of  this  problem. 
Whitney  was  the  first  to  provide  a stability  analysis  of  a 
force-controlled  manipulator  and  concluded  that  high  bandwidth 
force  control  required  a compliant  sensor  or  environment  [31]. 
Drawbacks  to  a soft  sensor  include  retardation  of  the  force 
response  and  deterioration  of  the  accuracy  of  position 
control.  Both  An  and  Hollerback  [37,  38]  and  Kazerooni  et  al. 
[42]  showed  that  the  tradeoff  might  be  attributed  to  unmodeled 
dynamics.  An  and  Hollerback  also  addressed  the  instabilities 
due  to  kinematic  coordinate  transformations  (kinematic 
stability)  and  the  stiffness  effects  with  the  environment 
(dynamic  stability).  Eppinger  and  Seering  [39,  40,  41] 
carried  out  extensive  stability  analyses  based  on  a series  of 
mass-spring-dashpot  single-axis  models.  They  showed  that 
stability  problems  arose  due  to  non-colocation  of  the 
actuators  and  the  sensors. 

Kinestatic  instability  was  found  to  be  another  type  of 
instability  in  hybrid  control,  first  observed  by  Lipkin  and 
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Duffy  [43,  44,  45].  It  results  from  strategies  that  are  not 
invariant  with  respect  to  change  of  origin,  basis,  or  scale. 
This  instability  phenomenon  is  associated  with  the  problem  of 
filtering  spatial  force  and  motion  signals  which  can  cause 
dimensional  dissimilarity.  Lipkin  and  Duffy  determined  the 
criteria  to  prevent  kinestatic  instability  was  that  the 
decomposition  process  be  invariant  with  respect  to  a change 
of  origin,  basis,  or  scale. 

Force  control  in  robotic  research  has  concentrated 
heavily  on  assembly  and  deburring  tasks.  Fine  motions  are  all 
required  and  small  control  gains  are  sufficient  for  these 
tasks.  For  the  reason  of  simplicity,  the  analyzed  systems  are 
often  modeled  as  single  DOF  systems. 

Other  than  the  assembly  and  deburring  tasks,  Khatib  and 
Burdick  in  [30]  introduced  "zero  force"  control  on  the  Z- 
direction  of  a PUMA  560  robot.  The  robot  dynamics  were 
mathematically  decoupled  to  demonstrate  the  computed-torque 
control.  Maples  and  Becker  in  [36]  introduced  their  "teach 
mode"  on  a planar  AdeptOne  robot,  in  which  the  robot  was 
expected  to  respond  to  external  forces.  The  external  forces 
were  transformed  into  accelerations  by  selected  compensators 
with  the  gain  of  0.005.  The  above  two  control  algorithm 
experiments  were  developed  in  Cartesian  coordinates.  Since 
these  operations  were  by-products  of  an  assembly  operation, 
they  showed  the  ability  of  the  robot  to  comply  to  external 
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force  commands  but  did  not  report  further  consequences  or 
developments. 


3 . 2 Joystick  Subsystem 

The  factory-supplied  PUMA  robot,  when  the  servo  is  on, 
will  remain  at  the  commanded  positions  and  orientations  even 
if  external  wrenches  are  applied.  The  present  work  adds  an 
external  loop  around  the  original  control  loop  to  accommodate 
the  operator's  application  of  wrenches.  In  this  way,  the 
servo  of  the  original  system  is  being  used.  The  system  is 
shown  in  Figure  3.1. 

A commercially  available  wrist  force/torque  sensor,  the 
FT-15/50  supplied  by  Lord,  is  used  in  the  PRJS.  The  sensor 
comes  with  a controller  unit,  a sensor  transducer  unit,  a 
preprocessor  unit,  and  cables  to  connect  them  together.  It 
can  measure  forces  up  to  15  lbf  and  torques  up  to  50  lbf-in 
with  resolutions  of  0.2  oz  in  the  X-  and  the  Y-directions  of 
the  sensor  coordinate,  0.6  oz  in  the  Z-direction  of  the  sensor 
coordinate,  and  0.4  oz-in  for  torques.  The  sampling  rate  of 
this  system  can  be  as  high  as  104  Hz  [46]. 

Once  the  force/torque  sensor  is  installed,  a design  of 
a control  scheme  is  needed  for  the  PRJS.  The  control  scheme 
should  be  general  enough  so  that  it  can  be  applied  with  only 
minor  modifications  to  a variety  of  robots.  It  is  even  better 
if  the  control  scheme  can  be  carried  out  without  detailed 


qe 


q : Output  joint  angle 

qe : Externally  applied  movement 

qc  : Commanding  joint  angle 

q<i  : Feedback  delta  joint  angle 

wn : Natural  frequency 

ke : Environmental  stiffness  constant 

Fs : Sensed  force/torque 

f : Damping  ratio 


Figure  3.1  System  Configuration  of  a Single  Degree-of- 
Freedom  Joystick  Subsystem 
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knowledge  of  the  joint  controller,  because  this  information 
is  usually  proprietary. 

Note  that  the  robot  is  inherently  a low  bandwidth 
flexible  system.  When  the  force/torque  sensor  is  attached  to 
the  end  of  this  flexible  structure,  a high  feedback  gain  will 
produce  instability.  Therefore,  only  limited  gains  can 
produce  a stable  system  with  the  application  of  a wrist 
force/torque  sensor.  Furthermore,  the  measured  wrenches, 
which  are  in  Cartesian  coordinates,  need  to  be  transformed 
into  joint  torques. 

In  order  for  the  TANDY  4 000  computer  to  take  over  control 
of  the  robot  system,  an  economical  approach  is  to  let  the  two 
ribbon  cables  with  40-pin  connectors,  which  connect  the  AIB 
to  the  DRV-11  parallel  interface,  be  redirected  to  the  PC-11 
parallel  interface  in  the  TANDY  4000  computer.  The  TANDY  4000 
computer  then  emulates  the  control  protocols  just  as  the  LSI- 
11/02  CPU  does.  Under  this  circumstance,  the  so-called  DEC- 
components  in  the  PUMA  controller  are  all  isolated. 

Once  the  connection  is  completed,  the  TANDY  4000  computer 
is  ready  to  communicate  with  the  joint  microprocessors  of  the 
PUMA  robot.  The  procedures  INITIAL  and  CALIB  in  the  TANDY 
4 000  computer  need  to  be  executed  so  that  the  computer  and  the 
joint  microprocessors  can  recognize  the  same  measurement 
system. 

Figure  3.2  shows  the  block  diagram  of  the  PRJS.  The 
TANDY  4000  computer  in  the  system  has  an  80386  microprocessor, 
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To  a Remote  Computer 


Figure  3.2  Block  diagram  of  the  PUMA  joystick  subsystem 
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an  80387  coprocessor,  a 16  MHz  system  clock,  and  an  RS-232C 
serial  port.  Two  parallel  interfaces,  one  XT-11  card  and  one 
PC-11  card,  which  emulate  the  DEC  DRV-11  parallel  interface, 
are  also  installed  in  the  system.  The  XT-11  card  reads  the 
wrench  information  from  the  FT-15/50  force/torque  sensor  once 
every  cycle.  The  PC-11  card  takes  care  of  the  communication 
between  the  TANDY  computer  and  the  AIB  in  the  PUMA  controller. 
With  this  configuration,  the  DEC-11/02  CPU  of  the  factory- 
supplied  PUMA  system  is  abandoned  and  thus  the  VAL  codes  in 
the  EPROM  are  not  accessible.  The  TANDY  computer  must  take 
charge  of  all  the  command  generations  and  the  I/O  with  the 
joint  microprocessors  of  the  robot. 

The  next  paragraph  describes  some  signal  flows  at  the 
chip  level  of  the  PC-11  interface.  They  are  helpful  only  for 
those  who  work  on  the  hardware  signal  checking. 

In  this  subsystem,  the  addresses  of  the  PC-11  interface 
are  selected  as 

Control  Status  Register  = 3 0016, 

Output  register  = 30216,  and 
Input  Register  = 30416. 

CSRO , bit  4 of  the  control  status  register  of  the  PC-11 
interface  [47],  is  used  to  direct  the  data  flow.  When  CSRO 
is  zero,  data  written  to  the  output  register  are  taken  as  a 
command.  When  CSRO  is  one,  data  are  taken  as  the  data 
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corresponding  to  the  previously  issued  command  and  can  be 
written  to  the  output  register  or  be  read  from  the  input 
register,  depending  on  the  issued  command.  During  an  output 
cycle,  a NEW  DATA  READY  pulse  from  the  PC-11  interface  is 
generated  to  inform  the  joint  microprocessors  in  the  PUMA 
controller  of  data  transfer.  The  trailing  edge  of  this 
positive-going  pulse  passes  data  into  the  joint 
microprocessors.  During  an  input  cycle,  when  a read  of  the 
lower  byte  is  performed,  a positive-going  DATA  TRANS  pulse  is 
generated  which  informs  the  joint  microprocessors  of  the  PUMA 
controller  that  data  have  been  accepted.  The  trailing  edge 
of  the  pulse  indicates  that  data  transfer  has  been  completed. 

The  status  of  REQ  A,  which  is  readable  from  bit  3 of  the 
control  status  register  of  the  PC-11  interface,  indicates 
whether  the  signal  is  ready  to  be  transferred  or  not.  Data 
should  not  be  read  from  the  input  register  or  written  to  the 
output  register  before  REQ  A bit  is  set  to  be  one. 

Special  care  must  be  taken  in  using  the  PC-11  interface 
in  order  to  have  proper  communications.  The  design  of  the  PC- 
11  interface  uses  an  8-bit  architecture  to  emulate  the  DRV-11 
interface  which  has  a 16-bit  architecture.  After  a command 
character  is  written  to  port  30216,  a dummy  character  should 
be  written  to  port  30316  in  order  to  keep  synchronization  of 
communication . 

To  execute  a program  involving  low-level  I/O  functions 
on  a personal  computer,  a difficult  situation  comes  about  when 
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the  executed  program  is  not  completed  properly.  The  computer 
system  will  become  trapped  and  it  must  be  rebooted.  This  is 
certainly  not  convenient  for  developing  and  testing  programs. 
The  language  available  in  the  TANDY  computer  is  Turbo-C  2.0 
from  Borland  company  running  under  MS-DOS.  The  Turbo-C 
environment  provides  a good  solution  with  the  Ctrl-Break  key 
which  allows  the  computer  to  get  back  to  the  program  without 
rebooting. 

The  Turbo-C  environment,  however,  does  have  some 
drawbacks.  When  a program  is  executed,  all  the  parameters  are 
allocated  to  certain  memory  locations.  If  the  program  is  not 
modified,  Turbo-C  will  not  recompile  it.  Under  this 
circumstance,  the  content  of  the  allocated  memory  will  not  be 
updated  when  the  same  program  is  executed  again,  regardless 
of  the  initialization  statements.  An  extra  key  stroke,  Ctrl- 
F2,  to  reset  the  program  is  reguired.  It  releases  the 
allocated  memory  from  the  previous  run.  This  "reset  program" 
key  is  especially  necessary  when  the  computer  system  is 
communicating  with  another  computer  in  order  to  eliminate  the 
unwanted  characters  in  the  buffer. 

Effective  control  of  the  PUMA  robot  as  a joystick 
reguires  execution  of  all  actions  within  the  28  msec  cycle 
time.  In  this  time  period,  the  TANDY  computer  reads  the 
encoder  codes  from  the  PUMA  robot,  reads  the  wrench 
information  from  the  wrist  force/torgue  sensor,  and  generates 
the  position  commands  according  to  the  collected  information 
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and  the  control  scheme.  Consequently,  the  program  codes  must 
be  simple  enough  for  real-time  execution  on  the  TANDY 
computer.  Those  statements  for  I/O  functions  are  required  and 
cannot  be  further  optimized  within  the  current  working 
environment,  unless  an  assembly  language  compiler  is 
available.  Other  computation  codes  should  be  watched 
carefully.  Although  data  structure  represents  a clear  concept 
of  programming  and  the  pointer  is  an  efficient  tool  in  the  C 
language,  all  parameters  in  the  control  program  are  kept 
constant  as  long  as  possible.  Also,  "assign"  statements  which 
can  be  eliminated  are  removed  so  that  the  condensed  program 
codes  are  obtained.  In  this  way,  the  program  codes  are 

optimized  for  execution  speed. 

For  now,  an  RS-232C  port  in  the  TANDY  computer  serves  as 
a communication  port  when  the  connection  between  the  PRJS  and 
a remote  device  is  considered.  With  the  assistance  of  this 
serial  port,  joint  commands  can  be  sent  to  the  remote  device 
and  the  reflecting  force  information  can  be  fed  back  to  the 
PRJS  from  a remote  device. 

3 . 3 Application  of  the  Jacobian  Matrix 
Considering  a system  in  static  equilibrium,  the  principle 
of  virtual  work  can  be  expressed  by 

f • Sx  = r-se 


(3.1) 
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where  F is  a 6x1  vector  of  wrenches  acting  on  the  handgrip, 
6x  is  a 6x1  vector  of  generalized  infinitesimal  displacements 
of  the  handgrip,  r is  a 6x1  vector  of  joint  torques,  60  is  a 
6x1  vector  of  infinitesimal  joint  displacements,  and  " •" 
denotes  the  inner  product  of  two  vectors.  Expression  (3.1) 
can  also  be  written  as 

Ft6x  = rT69  (3.2) 

where  the  superscript  "T"  denotes  the  matrix  transpose.  The 
definition  of  the  Jacobian  is 

6x  = [Jacobian] 60.  (3.3) 

Substituting  equation  (3.3)  into  equation  (3.2)  yields 

Ft6x  = FT[  Jacobian] 60  = £T60.  (3.4) 

The  relation  between  wrenches  and  joint  torques  can  be 
obtained  by  transposing  equation  (3.4)  as 

£ = [Jacobian]1"  F.  (3.5) 

Be  aware  of  the  fact  that  the  Jacobian  is  a function  of 
joint  angles.  Hence,  different  Jacobian  matrices  will  result 
with  respect  to  different  reference  coordinates.  In  addition, 
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the  Jacobian  matrix  needs  to  be  updated  whenever  the 
configuration  of  the  robot  is  changed.  This  can  introduce  a 
heavy  computational  load. 

Several  researchers  have  recognized  that  the  simplest 
computations  of  the  Jacobian  matrix  occur  for  the  coordinate 
system  whose  origin  is  located  at  the  intersection  of  three 
wrist  joints.  This  is  true  for  robots  such  as  the  PUMA  [48, 
49,  50,  51,  52].  Amongst  those  researchers,  Hunt  introduces 
his  selection  of  a referencing  coordinate  system  (O4.X4.Y4.Z4.)  as 
shown  in  Figure  3.3  [51].  In  this  coordinate  system,  04.Y4.  is 
made  to  be  parallel  to  OjYj  Based  on  screw  theory,  the 
Jacobian  matrix  with  minimum  mathematical  operations  can  be 
obtained  by  inspecting  the  figure. 

Conceptually,  screw  theory  is  considered  as  an  elegant 
tool  to  investigate  kinestatics  (kinematics  and  statics) . A 
practical  implementation  of  screw  theory  is  desirable  for  the 
application  of  the  Jacobian  matrix.  For  those  readers  who  are 
interested  in  the  theoretic  background  of  screw  theory,  a list 
of  references  [such  as  43,  44,  53,  54,  55]  is  helpful. 

A line  in  (OjXjYjZj)  space  can  be  represented  as 


Sj 


— jx— j 


(Lj,  Mj,  Nj?  Pj,  Qj,  R;)7, 


(3.6) 


where  the  symbol  "x"  denotes  the  cross  product  of  vectors,  Sj 
denotes  a 3x1  vector  representing  the  direction  of  jj>jf  r 
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Figure  3.3  PUMA  600  Robot  with  Coordinate  System  Suggested 
by  Dr.  Hunt  [51] 
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denotes  a 3x1  vector  pointing  from  the  origin  Oj  to  a point  on 
the  line,  and  HjXSj  represents  the  moment  of  the  line  with 
respect  to  the  origin  Oj. 

When  a screw  is  designated  for  each  revolute  joint,  the 
Jacobian  matrix  of  a 6-DOF  serial  robot  can  be  expressed  as 


J 


S, 

rjXSi 


Si 

r2xS2 


& 

r3xS3 


S4 

^xS 


Ss 


S* 


(3.7) 


When  the  coordinate  frame  is  chosen  at  the  interaction  of  the 
last  three  joints,  the  cross  product  terms  r^xE^,  rjXSj,  and 
r^xf^,  all  become  zero  vectors  and  the  number  of  elements  to  be 
calculated  in  the  Jacobian  matrix  is  reduced. 

The  Jacobian  matrix  associated  with  the  coordinate  frame 
(04,X4,Y4,Z4.)  is  obtained  as 


J = 


“^23 

0 

C23 

-FCa, 

(HS23+GC2) 

-fs23 


0 

1 

0 

(H+GS3) 

0 

— GC, 


0 

1 

0 

H 

0 

0 


0 

0 

1 

0 

0 

0 


-s4  S5C4 


c4  S5S4 


0 C5 

0 0 

0 0 

0 0 


(3.8) 


In  order  to  apply  this  Jacobian  matrix  with  wrenches 
acting  at  the  end-effector,  the  transpose  of  this  Jacobian 
matrix  must  be  post-multiplied  by  a 6x6  correction  matrix 
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A = 


[03]  [I3] 
[I3]  [03]  , 


(3.9) 


where  [03]  is  the  3x3  null  matrix  and  [I3]  is  the  3x3  identity 
matrix.  Thus, 


JtA  = 


-FC23  (HS23+GC2) 


(H+GS3)  0 

H 0 

0 0 

0 0 

0 0 


— FS^  — 0 C23 

-Gc3  0 10 

0 0 10 

0 0 0 1 

0 -s4  c4  0 

0 S5C4  S5S4  c5 


Furthermore,  wrenches  are  measured  at  locations  different 
from  the  place  where  the  Jacobian  matrix  is  computed.  We 
also  need  the  transformation  between  these  two  coordinate 
systems. 

Given  two  coordinate  systems,  (OjXjYjZj)  and  (OjXjYjZj)  , the 
coordinates  of  Oj  with  respect  to  (0^^)  can  be  expressed  by 
a vector  (x^,  y^,  z^)T . A screw  in  the  (OjXjYjZj)  system  can  then 
be  transformed  into  the  (OjX^Z,)  system  by  the  transformation 
matrix 


[$] 


[R]  [03] 

[ D] [R]  [R] 


(3.10) 
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where  [R]  is  a 3x3  orthogonal  rotation  matrix,  given,  for 
example,  as 


[R]  = 


Ci  Si  0 

S,  Ci  0 

0 0 1 


in  the  case  when  OjZj  and  0^  are  parallel  to  each  other  and  the 
orientation  of  (OjXjYjZj)  with  respect  to  (OjXjYiZi)  is  specified 
by  an  angle  ©j  using  the  right-hand  rule.  The  matrix  [D]  is 
a 3x3  skew-symmetric  matrix  in  terms  of  the  coordinates  of  Oj 
relative  to  the  (OjXjYiZi)  system,  given  as 


[D]  = 


0 -Zy  Yy 

zij  0 ~Xy 

-y  y Xjj  0 


Thus,  a pure  rotational  transformation  matrix  corresponding 
to  axis  A with  an  angle  0 can  be  defined  by  a 6x6  matrix  as 


[Rot (A, 0) ] 


[R]  [03] 

[03]  [R] 


(3.11) 


and  a pure  translational  transformation  matrix  corresponding 
to  axis  A with  a distance  L, 


[Tran (A, L) ] 


[03] 

[D] 


[03] 

[03] 


(3.12) 
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The  measured  wrenches  are  mapped  from  coordinates  (06X6Y6Z6)  to 
(O4.X4.Y4.Z4.)  by  applying  these  transformation  matrices.  That  is 

F = TFg  (3.13) 


with 


or 


where 


T = [Rot  (Z4,04)  ] [Rot(Z5,©5)  ] [Rot(Z6,06)  ] [Tran(Z6, 1)  ] 


[A] 

[03] 

[B] 

[A] 

[A] 


(C6C5C4-S6S4) 

-c6s5 


— (^6^504+0^84)  S5C4 

( -S6C5S4+C6C4)  S5S4 

^6^5  C5 


-L(S6C5C4+C6S4) 
i*  ( — S6C5S4+S6C4) 
ls6s5 


-L(C6C5C4-S6S4)  0 

-L(C6C5S4+S6C4)  0 

lc6s5  0 


and  [03]  is  the  3x3  null  matrix.  Hence,  the  joint  torques  can 
be  obtained  by 


r = [ JtA  ] TF, . 


(3.14) 
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The  order  of  computations  for  the  elements  of  the 
transformation  matrix  is  also  important.  With  an  appropriate 
arrangement,  computational  operations  can  be  reduced.  For 
example,  after  the  elements  in  the  first  column  of  matrix  [A] 
are  calculated,  the  elements  in  the  second  column  of  matrix 
[B]  can  be  obtained  by  multiplying  L with  them. 

3 . 4 Stability  Analysis 

The  approaches  to  evaluate  the  stability  of  system 
dynamics  are 

1)  Routh  criterion,  if  no  delay  is  involved, 

2)  Bode  plot,  also  if  no  delay  is  involved,  and 

3)  Nyquist  plot,  if  time  delay  is  involved. 

The  Routh  criterion  may  give  a closed  form  for  the 
stability  boundary,  depending  on  the  order  and  the  complexity 
of  the  characteristic  equation  obtained  from  the  closed-loop 
transfer  function  of  the  system.  A Bode  plot  shows  the 

stability  of  the  system  based  on  the  open-loop  transfer 
function.  Since  0 dB1  corresponds  to  a magnitude  of  1,  the 
gain  margin  is  the  number  of  dB  of  the  magnitude  |GH(jw)  | 
below  0 dB  at  the  phase  crossover  frequency  where 

arg(GH(jwT))  = 180°.  The  phase  margin  is  the  number  of 


1 dB  = 201og|GH(jw) | . 
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degrees  of  arg(GH(jw))  above  -180°  at  the  gain  crossover 
freguency  ull  where  | GH  ( j Wj)  | =1.  A Bode  plot  gives  the  gain 
margin  and  phase  margin  of  the  system.  Positive  gain  margin 
and  positive  phase  margin  assure  stability  of  the  closed-loop 
system.  When  a time  delay  is  involved,  a closed  form  for  the 
stability  boundary  is  hardly  ever  obtained.  Alternatively, 
the  stability  can  be  determined  from  a Nyquist  plot. 
Actually,  stability  of  the  system  can  be  decided  by  a glance 
at  the  Nyquist  plot. 

Industrial  robots  are  often  designed  with  second-order 
critical  damping  systems.  A single  degree-of-freedom  robotic 
system  with  a force  feedback  loop  looks  like  Figure  3.1.  The 
diagram  can  further  be  arranged  to  be  a commonly-used  negative 
feedback  system,  as  far  as  the  open-loop  transfer  function, 
<3d/<lc,  and  the  closed-loop  transfer  function,  q/qc,  are 
concerned.  An  equivalent  system  is  shown  in  Figure  3.4  and 
will  be  used  for  stability  analysis  of  the  system. 

Consider  the  compensator  as 


1 

D (s)  = 

Bs  + K 


(3.15) 


where  B is  the  damping  constant  and  K is  the  stiffness 
constant;  then. 
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Figure  3.4  Equivalent  Configuration  of  a Single  Degree-of- 
Freedom  Joystick  Subsystem 
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Gop(S)  - 2 2 ' 

q,  (Bs  + K)  (s2  + 2f  Wns  + Wn2) 


q . 

Gcl  ( s ) — — 

q,  (Bs  + K)  (s2  + 2TW„S  + CJn2)  + Ua\ 


The  characteristic  equation  looks  like 


BS3  + (K  + 2fWnB)s2  + (Wn2B  + 2fWnK)s  + (K  + Ke)W„2. 


The  stability  conditions,  according  to  the  Routh  criterion, 
require 


B > 0, 

K + 2fWnB  > 0, 

(K  + 2f(dnB)  (W„2B  + 2fWnK)  > (K  + Ke)Un2B, 
or 

K > -fU„B  + (f2Wn2B2  - Wn2B2  + 0.5WnKeB)%. 

For  an  industrial  robot  which  has  a damping  ratio  of  one, 

K > -WnB  + (0.5wnKeB)\  (3.16) 

The  relation  between  the  damping  constant  B and  the  stiffness 
constant  K can  be  plotted  as  Figure  3.5  once  Ke  is  picked.  As 
can  be  seen  from  the  figure,  for  a stiffer  environment  where 
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Figure  3.5  Damping-Stiffness  Curves  with  Variable 
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Ke  is  large,  the  stable  zone  becomes  smaller.  After  the 
stability  boundary  curves  pass  through  their  peak  values  of 
K,  K becomes  more  or  less  proportional  to  -B.  The  performing 
point  must  be  chosen  within  the  stable  zone.  It  is 
understandable  from  the  figure  that  for  a performing  point 
with  a small  value  of  B,  a very  large  value  of  K is  required. 
This  is  certainly  not  good  for  the  application  of  a joystick 
system.  Since  a good  amount  of  B is  always  needed  to  damp  out 
the  undesired  energy  for  a joystick  system,  a fixed  small 
value  of  K and  a large  value  of  B are  selected.  Figure  3.6 
shows  a Bode  plot  with  different  values  of  B in  the  case  of 
Ke  = 18.5  lbf/in,  K = 1 lbf/in.  The  results  confirm  what  is 
shown  in  Figure  3.5  where  the  stable  zone  occurs  for  B larger 
than  0.4  lbf-s/in. 

It  as  also  observed  that,  as  long  as  the  square  root  term 
in  equation  (3.16)  is  kept  positive,  the  damping  ratio  has 
little  effect  on  the  system  stability.  A case  with  Ke  = 20 
lbf/in  is  plotted  as  Figure  3.7  for  variable  damping  ratios. 
As  can  be  seen,  the  stability  boundary  curves  change  slightly, 
especially  when  a small  value  of  K is  selected.  Another 
interesting  observation  is  that  a string  with  K = 0 always 
passes  through  the  same  points  of  the  set  of  curves  which  have 
the  same  value  of  K,,. 

Although  the  PRJS  has  only  one  CPU,  the  program  codes 
have  been  condensed  and  can  be  executed  completely  in  every 
cycle.  The  time  delay  is  therefore  not  significant. 


The 
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Figure  3.6(d)  Bode  Plot,  B = 0.9,  K = 1 
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Figure  3.7  Damping-Stiffness  Curves  with  Variable  Damping  Ratio,  Ke  = 20  lb/ in 
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influence  of  time  delay  to  the  control  system  is,  however, 
explored  as  a reference. 

The  open-loop  transfer  function  of  the  model  with  a time 
delay  Td  is 


q,  ua%e™ 

Gop  ( S ) ~ “ ~2  2 ' 

q,  (Bs  + K)  (s  + 2fWns  + Cdn2) 

By  setting  the  phase  margin  to  zero,  a relation  between 
impedance  control  design  parameters  K and  B is  provided. 
This  relation  is  given  by  two  nonlinear  equations  in  the 
frequency  u as 

wn2Ke  = [((wn2  - u2)2  + (2f wnw) 2)  (K2  + B2w2)  ]*, 

2funu  Bw 

-7T  = - tan'1  ( ) - tan'1  ( ) - wTd. 

wn2  - w2  K 

Owing  to  the  nonlinearity,  an  analytic  solution  needs  to  be 
obtained  by  numerical  methods. 

Nyquist  plots  for  the  systems  with  and  without  delay 
are  plotted  as  Figure  3.8  and  Figure  3.9,  respectively.  It 
is  found  that  the  time  delay  has  quite  an  influence  on  system 
stability.  Using  the  same  case  of  the  previous  example,  Ke  = 
18.5  lb,/in,  K = 1 lb/in,  B is  now  shifted  from  0.4  lbf-s/in  to 
0.9  lbf/in  in  order  to  keep  the  system  stable.  A larger  value 
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Figure  3.9  System  Nyquist  Plot  with  a Delay  of  0.028  Sec 
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of  B is  required  for  the  system  with  a longer  delay.  Bode 
plots  for  the  systems  with  a time  delay  of  one  cycle  are  shown 
in  Figure  3.10  for  comparison. 
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Figure  3.10(a)  Bode  Plot  with  a Delay  of  0.028  Sec 
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Figure  3.10(d)  Bode  Plot  with  a Delay  of  0.028  Sec 


CHAPTER  4 

EXPERIMENTAL  IMPLEMENTATION  AND  RESULTS 


Primitively,  the  PUMA  robot  can  be  controlled  by  either 
motor-current  commands  or  joint-angle  commands.  Since  most 
robot-control  literature  refers  to  torque  control,  and 
actuator  torque  is  a function  of  motor  current,  motor-current 
commands  were  experimented  to  control  the  robot.  Experimental 
results  showed  that  this  approach  was  less  than  satisfactory 
because  of  the  dominant  effects  of  Coulomb  and  viscous 
friction.  Therefore,  joint-angle  commands  were  adopted  in 
this  project. 

There  are  many  advantages  to  controlling  a robot  system 
with  joint-angle  commands.  None  of  the  kinematic 
singularities  of  the  robot  arise,  and  fewer  computations  are 
involved,  since  the  transformations  between  the  world 
coordinate  system  and  the  joint  coordinate  system  are 
eliminated.  Physical  joint  angles  are  attractive  for  use  when 
controlling  a robot  because  of  their  intuitive  nature. 
However,  it  is  far  more  efficient  to  use  encoder  codes  because 
they  are  the  default  measurement  system  of  the  joint 
microprocessors.  If  joint  angles  are  utilized,  they  must  be 
converted  into  encoder  codes  before  being  sent  to  the  joint 
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microprocessors.  Feedback  encoder  codes  must  also  be 
converted  into  joint  angles  to  close  the  control  loop.  This 
certainly  costs  more  computations  than  in  the  case  of  using 
joint-encoder  codes.  Furthermore,  joint  angles  are  normally 
carried  as  "real"  numbers,  whereas  encoder  codes  are  used  in 
"integer"  form.  Conversion  procedures  can  produce  truncation 
errors.  In  this  chapter,  joint  angles,  which  indeed  relate 
to  encoder  codes,  are  used  for  illustration. 

4 . 1 On-Desk  Sensor 

At  the  first  stage  of  this  project,  the  FT-15/50 
force/torque  sensor  was  placed  on  the  desk  as  a commanding 
device  for  the  PUMA  600  robot.  This  experiment  gave  a taste 
for  driving  the  robot  with  the  application  of  wrenches  on  a 
remote  device.  It  verified  that  no  dynamic  modes  were 
involved  when  integrating  a signal  into  a system  with  no 
physical  attachment  to  the  system.  This  statement  is  true 
even  if  a force/torque  sensor  is  used.  Telepresence  was 
arranged  in  this  experiment  through  geometrical 
transformations.  Also  shown  was  that  a different  approach  for 
stiffness  control  was  feasible. 

Experience  shows  that  it  is  desirable  to  arrange  the 
coordinate  system  of  the  force/torque  sensor  on  the  desk  to 
align  with  the  world  coordinate  system  of  the  PUMA  robot  so 
that  the  wrenches  acting  on  the  sensor  can  move  the  end- 
effector  of  the  PUMA  robot  in  the  same  direction.  This  sense 
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of  telepresence  is  simply  obtained  by  the  geometric 
transformation  between  the  sensor  coordinate  system  and  the 
world  coordinate  system.  For  example,  in  order  to  respond  the 
wrenches  applied  to  the  coordinate  frame  attached  to  the 
center  of  joint  four,  the  rotation  matrix  can  be  expressed  by, 
as  seen  in  Figure  4.1, 


where 


and 


T = [Rot(Z,01)  ] [Rot (¥,023)  ] 


(4.1) 


[RotfZ,^)]  = 


Cj  0 

-S!  Cx  0 

0 0 1 

0 0 0 

0 0 0 

0 0 0 


0 0 0 

0 0 0 

0 0 0 

Cj  Sj  0 

-Sj  Cj  0 

0 0 1 


[Rot  (¥,023)  ] 
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The  measured  wrenches  need  to  be  transformed  into  the  joint 
torques  in  the  world  coordinates  by 
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Figure  4.1  Telepresence  Coordinate  Transformation  of  the  On- 
Desk  Sensor 


[JtA]TFs. 
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(4.2) 


r = 


Applying  these  resulting  torques  with  stiffness  control,  which 
is  a special  case  of  impedance  control,  the  angular 
displacements  to  drive  each  joint  of  the  robot  are  obtained. 

The  term  "stiffness  control"  in  this  experiment  is 
different  from  its  classical  meaning.  Salisbury's  definition 
of  stiffness  control  [29]  is  a typical  one  in  the  literature 
of  robotic  control,  which  defines  a stiffness  matrix  based  on 
Cartesian  coordinates.  That  is,  the  stiffness  matrix  K in 
Cartesian  coordinates  is  a diagonal  matrix.  The  formulation 
of  the  joint  torque  can  then  be  obtained  as 

£ = JT-K-Jdq  = Ke-dq,  (4.3) 

where  K Q denotes  the  torsional  stiffness  matrix. 

Salisbury  claimed  that  the  torsional  stiffness  matrix  was 
not  a diagonal  matrix.  Salisbury's  method  failed  for  his 
torque-controlled  system  as  the  manipulator  approached  any 
kinematic  singularity  where  zero  joint  torques  would  result. 

Taking  a closer  look  at  the  expression  JrK-J,  we  observe 
that  it  contains  dimensional  inconsistency,  and  thus  is 
physically  meaningless. 

A more  robust  approach  for  stiffness  control  is  explored 
in  this  experiment.  The  definition  of  the  stiffness  matrix 
in  this  work  is  determined  by  the  type  of  joints  of  the 
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manipulator  arm.  When  a prismatic  joint  is  involved,  a 
definition  of  linear  stiffness  is  a reasonable  choice.  When 
a revolute  joint  is  discussed,  a definition  of  the  torsional 
stiffness  is  used.  Thus,  a diagonal  angular-stiffness  matrix 
can  be  obtained  for  a robot  with  revolute  joints,  such  as  the 
PUMA  robot. 

In  this  experiment,  the  wrenches  measured  by  the  wrist- 
mounted  force/torque  sensor  are  transformed  into  joint  torques 
as  in  equation  (4.2) . The  resulting  joint  torques  are  divided 
by  the  specified  torsional  stiffness  of  each  joint  to  obtain 
joint  displacements.  The  torsional  stiffness  for  each  joint 
can  be  adjusted  to  a desired  value  by  the  software. 

The  results  of  the  on-desk  experiment  showed  that  the 
robot  responded  perfectly  — application  of  a "fingertip"  to 
the  force/torque  sensor  produced  a desired  response  on  the 
part  of  the  PUMA  robot.  Even  when  the  operator  shook  his  hand 
on  the  sensor,  the  PUMA  robot  duplicated  the  motion 
sensitively.  Since  there  was  no  interaction  between  the 
operator's  hand  and  the  robot,  force  information  after 
transformations  served  just  as  pure  angular-displacement 
commands  to  the  system  with  no  dynamics  involved.  A 
prediction  was  made  for  those  devices  producing  pure  position 
commands  to  the  system,  so  that  similar  "nice"  responses  could 
be  expected. 


70 


Similarly,  if  the  pure  force  information  was  fed  from  a 
remote  manipulator  to  the  controller,  it  could  be  used  to 
generate  a pure  displacement  command  to  the  controller. 

4 . 2 Experiments  on  a Single-Axis  System 

The  application  of  a force/torque  sensor  in  a robotic 
joystick  subsystem  is  different  from  its  applications  in  the 
"fine  motion"  controls,  such  as  deburring  and  assembly 
operations.  In  these  applications,  the  robot  is  required  only 
to  move  with  small  displacements  and  small  control  gains.  On 
the  other  hand,  the  application  of  joystick  tends  to  bring 
about  gross  motions  in  its  whole  working  space  with  no  pre- 
specified paths.  Small  control  gains  are  thus  inadequate. 

Appropriate  mathematical  models  help  to  develop  intuitive 
understanding  of  system  behavior.  In  the  early  stages  of 
designing  control  strategies,  a mathematical  model  of  the 
robot  system  was  attempted.  Transfer  functions  of  joints  were 
identified  experimentally.  The  complication  of  the  complete 
model  of  the  robot  makes  it  impractical  for  real-time  control. 
The  combination  of  these  single  DOF  linear  models  is,  however, 
severely  limited  in  its  ability  to  present  the  real  system, 
which  includes  nonlinearities.  As  the  configuration  of  the 
robot  changes,  the  behavior  of  the  robot  is  made  more 
complicated. 

Pragmatically,  control-gain  limits  were  eventually 
established  experimentally. 
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When  the  force/torque  sensor  is  attached  to  the  robot, 
dynamic  interaction  between  the  operator  and  the  sensor  is 
involved  in  the  system  operation.  System  stability  suddenly 
becomes  a critical  issue  in  order  for  the  PRJS  to  perform 
well . 

In  attempting  to  reduce  the  excitation  of  undesirable 
dynamic  modes,  several  strategies  were  tested.  These  trial 
strategies  were  applied  to  the  PRJS  under  an  assumption  that 
independent  joint  control  of  the  PUMA  controller  appropriately 
takes  care  of  the  servo.  Therefore,  only  a sufficiently 
smooth  command  profile  needs  to  be  generated  for  each  joint. 
A threshold  filter  for  each  degree  of  freedom  of  the  measured 
wrenches  is  set  in  order  to  filter  out  small  vibrations  from 
the  operator's  hand.  The  PRJS  can  be  moved  only  if  the 
applied  wrenches  are  larger  than  the  threshold  level.  The 
angular  displacement  commands  are  obtained  by  applying  these 
strategies  with  the  Jacobian  matrix  and  the  required 
coordinate  transformations  to  the  measured  wrenches. 

The  trial  strategies  are  as  follows: 

1)  0 = CjT , 

2)  W = C2T, 

3)  a = C3T,  and 

4)  U(i)  = [ (T ( i-2 ) + T(i-l)  + T(i)  ] x <V3, 
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where  Clf  C2,  C3/  and  C4  denote  the  control  gains  which  are 
determined  by  experiments  and  T(i)  represents  the  measured 
joint  torque  from  the  i-th  control  cycle.  Angular  velocity 
and  angular  acceleration  are  further  used  to  generate  angular 
displacements  for  commanding  the  PUMA  robot. 

The  first  trial  strategy  chooses  joint  torques  as 
functions  of  angular  displacements.  In  other  words,  stiffness 
constants  are  chosen  so  that  joint  torques  can  be  converted 
into  proportional  angular  displacements,  9 = CjT.  Similar 
strategies  have  been  used  by  Raibert  and  Craig  and  other 
researchers  in  hybrid  control  [26,  27].  Unlike  the  situation 
of  the  on-desk  sensor,  the  experimental  results  show  that  the 
system  is  stable  within  a very  narrow  bandwidth,  which  agrees 
with  indications  given  by  Figure  3.5.  Only  when  the  stiffness 
constants  are  very  large  is  the  PRJS  able  to  move  smoothly 
with  small  displacements.  When  small  stiffness  constants  are 
used,  the  joint  oscillates  and  makes  the  controlled  system 
unsuitable  as  a robotic  joystick  subsystem. 

When  joint  torques  are  specified  to  be  higher-order 
functions  of  angular  displacements,  less  excitation  of  system 
dynamics  are  expected  and  thus  the  bandwidth  of  the  dynamic 
ranges  will  be  wider  than  that  of  the  angular  displacement 
function.  The  second  trial  strategy  chooses  joint  torques  to 
be  the  first-order  function  of  angular  displacements,  w = C2T. 
Under  this  circumstance,  the  system  can  absorb  more  energy 
than  the  situation  of  the  first  trial  strategy,  and  the  PRJS 
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can  be  moved  around  by  the  operator  with  good  speed.  The  only 
problem  observed  in  this  case  is  that  the  feeling  of  the  PRJS 
in  the  operator's  hand  is  a little  heavy.  Although  different 
values  of  damping  can  be  adopted  to  adjust  the  feeling,  system 
stability  limits  the  performance.  Whenever  small  damping  is 
used,  less  energy  is  dissipated  and  the  PRJS  feels  lighter  in 
the  operator's  hand.  The  boundary  of  stability  can  be 
determined  experimentally. 

The  third  trial  strategy  uses  joint  torques  as  a second- 
order  function  of  angular  displacements,  a = C3T.  With  this 
strategy,  the  system  is  quite  stable  and  the  PRJS  feels  even 
lighter  than  in  the  previous  two  cases.  A boundary  of 
stability  still  exists.  While  the  PRJS  is  made  to  feel 
lighter  with  this  strategy,  it  is  also  easier  for  the  system 
to  drift. 

In  general,  with  higher-order  functions,  the  PRJS  has  a 
wider  stable  range,  feels  lighter  in  the  operator's  hand,  and 
its  motion  can  easily  be  sped  up.  However,  there  is  a 
drawback  in  using  high-order  functions  for  the  PRJS.  The 
trigger  signal  to  the  PRJS  is  the  operator's  application  of 
force.  With  a first-order  function,  the  PRJS  will  remain 
stationary  when  there  is  no  force  applied  to  its  handgrip. 
With  a second-  or  higher-order  function,  chances  are  that  when 
the  applied  forces  are  removed  from  the  PRJS ' s handgrip,  it 
will  still  move.  Under  this  situation  an  extra  strategy  is 
needed  to  stop  the  motion  of  the  PRJS,  and  a time  delay  occurs 
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between  the  moment  when  the  operator  instructs  the  PRJS  to 
stop  and  the  moment  when  the  PRJS  stops  its  movement.  A scary 
situation  can  take  place  when  joint  torques  are  specified  to 
be  second-order  functions  of  joint  displacement.  The  joint 
can  be  sped  up  with  only  a small  amount  of  force  applied. 
When  joints  are  moving  at  high  speed,  it  is  hard  for  the 
operator  to  feel  his  application  of  wrenches  to  the  grip.  The 
operator  may  illusively  believe  he  has  no  control  of  the 
joints.  With  the  coordinated  motion  of  multiple  joints,  the 
situation  is  made  worse.  Therefore,  second-  or  higher-order 
functions  are  not  recommended  for  application  to  a joystick. 
From  this  point  of  view,  it  seems  the  lower-order  functions 
are  natural  candidates  if  they  can  be  made  more  stable. 

In  order  not  to  excite  the  system  dynamic  modes,  a gentle 
transition  of  the  velocity  profile  is  necessary.  The  fourth 
trial  strategy  is  to  average  the  joint  torque  from  three 
measurements,  w(i)  = [(T(i-2)  + T(i-l)  + T ( i ) ] x CJ3.  By 
using  this  method,  the  system  turns  out  to  be  more  stable  and 
lighter  than  the  case  of  strategy  two,  and  the  performance 
can  be  tuned  to  be  close  to  that  of  strategy  three. 

Except  for  strategy  one,  which  has  a very  narrow  stable 
range,  the  other  strategies  are  further  analyzed.  In  a series 
of  experiments,  the  PRJS  is  requested  to  perform  similar 
motions.  The  histories  of  joint  torque  and  joint  angle  of 
joint  3 are  recorded  so  that  a comparison  can  be  made. 
Initially,  joint  torques  are  zero  before  the  motions  take 
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place  and  joint  3 stays  around  20  degrees  with  respect  to  its 
local  coordinate  system.  When  joint  torques  are  applied,  the 
PRJS  is  able  to  be  moved  as  a joystick.  The  maneuverability 
of  the  PRJS  and  its  sensitivity  to  the  operator's  instructions 
are  important  performance  factors. 

The  recorded  data  are  plotted  for  14  seconds  in  Figures 
4.2  to  4.4,  respectively,  with  a different  gain  for  each  case. 
In  general,  based  on  the  recorded  data,  a time  lag  between  the 
commanded  torque  and  the  responding  angular  displacement 
exists;  however,  the  operator's  hand  can  barely  sense  this 
delay. 

From  these  plots,  one  can  see  that  the  responding  period 
for  motion  to  take  place  is  almost  the  same  for  all  cases. 
This  indicates  that  the  time  period  which  is  occupied  by  the 
execution  of  force  measurement  and  computations  is  more  or 
less  the  same  for  all  cases.  What  makes  a difference  is  the 
time  period  in  which  the  motion  of  the  joint  finishes  the 
command . 

The  performance  results  for  strategy  two,  strategy  three, 
and  strategy  four  are  summarized  as  Table  4.1,  regarding  their 
response,  maneuverability,  lightness,  drifting,  and  boundaries 
of  stability.  Among  them,  the  performance  of  strategy  four 
is  between  strategy  two  and  strategy  three.  When  the  control 
gains  are  tuned  to  large  values  for  strategy  four,  its 
performance  can  be  almost  as  good  as  that  of  strategy  three, 
with  no  drifting.  In  conclusion,  strategy  four  is  a good 
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□ Torqu©_3 


Time  CseO 


Figure  4.2(a)  93  Response  of  Velocity  Function  with  Gain  = 0.5 


Figure  4.2(b)  03  Response  of  Velocity  Function  with  Gain  = 0.7 
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□ Torque_3 


Time  (sec) 


Figure  4.2(c)  03  Response  of  Velocity  Function  with  Gain  = 0.9 


Figure  4.2(d)  03  Response  of  Velocity  Function  with  Gain  = 0.11 
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Torque_3 


Time  (sec) 


Figure  4.3(a)  03  Response  of  Acceleration  Function  with  Gain  = 0.2 


Figure  4.3(b)  03  Response  of  Acceleration  Function  with  Gain  =0.3 
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Figure  4.3(c)  03  Response  of  Acceleration  Function  with  Gain  = 0.4 
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□ Torqu©_3 


Tim©  CsecO 


Figure  4.4(a)  e3  Response  of  Average  Velocity  Function,  Gain  = 0.5 


Tim©  £s©c) 

□ Torque_3  + theto_3 


Figure  4.4(b)  03  Response  of  Average  Velocity  Function,  Gain  = 0.7 
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Time  £sec) 

□ Torque_3  + theta_3 


Figure  4.4(c)  03  Response  of  Average  Velocity  Function,  Gain  = 0.9 


Figure  4.4(d)  03  Response  of  Average  Velocity  Function,  Gain  = 0.11 
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candidate  for  serving  the  purpose  of  a robotic  joystick 
subsystem  which  provides  a nice  feeling  on  the  operator's 
hand.  It  has  been  adopted  in  the  remote  force-reflection 
joystick  experiment. 


Table  4 . 1 Comparison  of  Performance 


Strategy  2 


Response 

Slowest 

Maneuver ab i 1 i ty 

Worst 

Lightness 

Heavy 

Drifting 

No 

Stable  Boundary 

Low 

Strategy  3 

Strategy 

4 

Fastest 

Close  to 

3 

Best 

Close  to 

3 

Light 

Moderate 

Yes 

No 

High 

Moderate 

4 . 3 Experimental  Observations  for  the  PRJS 
A reason  that  robot  manufacturers  hesitate  to  integrate 
force/torque  sensors  into  commercially  available  robots  is  the 
stability  problem.  When  a wrist  force/torque  sensor  is 
attached  to  the  end  of  a serial-link  robot,  the  bandwidth  of 
the  system  is  critically  reduced.  Thus,  the  system  is  easily 
driven  into  oscillations,  even  when  a small  load  is  applied. 
Dynamic  coupling  effects  between  links  deteriorate  its 
performance  even  more.  To  use  the  PUMA  robot  as  a multiple- 
degree-of-freedom  joystick  by  means  of  integrating  a wrist 
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force/torque  sensor,  the  adopted  control  gains  need  to  be 
smaller  than  their  marginal  limits  obtained  from  each  single- 
joint experiment.  The  experimental  results  confirm  this. 
When  the  marginal  gains,  which  were  measured  from  single- joint 
experiments,  were  used  for  multiple- joint  motions,  especially 
with  non-planar  motions,  the  PRJS  oscillates  severely.  With 
lower  gains,  the  PRJS  became  stable  and  easy  to  manage. 

Another  observed  phenomenon  is  that  the  PRJS  actually 
feels  lighter  than  each  single-joint  system.  This  is  because 
the  PRJS  with  multiple- joint  motion  can  respond  to  not  only 
a single-degree-of-freedom  torque,  but  also  all  the  directions 
of  wrenches.  The  PRJS  is  very  sensitive  to  the  operator's 
application  of  wrenches.  Different  operators,  who  have 
different  effective  damping,  generate  oscillations  with 
different  control  gains.  The  PRJS  becomes  unstable  at 
different  control  gains  for  an  operator  who  uses  stiff  hand 
as  opposed  to  one  who  uses  a soft  hand. 

When  limitations  to  the  operating  ranges  of  the  PRJS  are 
required,  boundaries  can  be  set  in  programming  codes. 
Experiments  have  been  performed  with  "hard  boundaries,"  which 
apply  inward  constant  torques  to  the  assigned  working  ranges. 
When  a joint  is  moved  out  of  its  working  range,  the  inward 
torque  is  applied.  If  the  joint  is  kept  outside  the  assigned 
working  range,  the  operator  feels  a constant  torque  pushing 
the  joint  back  to  its  working  range.  If  the  operator  releases 
the  joint  outside  of  its  working  range,  the  joint  moves  back 
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into  its  working  range.  When  a large  inward  step  torque  is 
used  for  the  PRJS  response,  a small  oscillation  can  arise  if 
the  operator  pushes  a joint  outside  of  its  boundary  using  a 
"stiff"  grip. 

For  each  joint,  when  it  is  rapidly  shaken,  the  operator 
feels  servo  frequency.  This  indeed  exists  for  every  force- 
reflecting  joystick  system.  As  long  as  this  feeling  is  kept 
consistently  small,  it  helps  the  operator  to  feel  that  the 
joystick  is  under  control. 

In  conclusion,  the  PRJS  with  strategy  four  can  be 
adjusted  to  operate  smoothly  at  moderate  speeds.  As  far  as 
the  application  of  joystick  controller  is  concerned,  the 
experiment  shows  promising  results.  The  only  flaw  with  the 
PRJS  is  that  the  handgrip  is  too  heavy.  The  force/torque 
sensor  senses  wrenches  when  the  handgrip  is  away  from  its 
initialization  orientation.  A lighter  handgrip  should  be 
installed  so  that  the  weight  of  handgrip  can  be  filtered  out 
in  the  controlling  program.  Although  the  controlling  program 
can  theoretically  be  made  to  filter  the  effects  of  a heavy 
handgrip,  a preferable  solution  is  to  design  a substantially 
lighter  handgrip. 

4 . 4 Remote  Force-Reflection  Joystick 

To  implement  an  experimental  system  with  remote  force 
reflection,  the  host  computer  and  the  remote  computer  are 
required  to  work  tightly  together.  One  has  to  notice  that  the 
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PUMA  robot  runs  at  a specified  cycle  time  of  28  msec.  In 
spite  of  all  the  other  computations  and  data  communications, 
the  host  computer  must  send  joint  commands  every  cycle  to 
joint  microprocessors  in  order  to  maintain  the  servo. 

To  incorporate  the  remotely  reflecting  force  signal  into 
the  PRJS , the  control  program  must  be  executed  with  minimum 
interference.  The  time  period  for  data  transmission  must  be 
made  as  short  as  possible.  In  the  meantime,  data  transmission 
must  not  happen  in  the  time  period  when  servo  operations  are 
taking  place. 

With  the  existing  facilities  in  CIMAR,  another  TANDY  4000 
personal  computer  is  used  as  a remote  computer.  Data 
communication  between  these  two  computers  is  through  a serial 
line.  In  order  to  speed  up  the  rate  of  data  communication, 
the  control  chip  of  the  serial  port  is  programmed,  and  data 
are  transmitted  at  38400  baud. 

Besides  the  communication  speed,  handshaking  of  data 
transmission  is  also  important.  Since  the  host  computer  for 
the  PRJS  needs  to  maintain  the  servos  in  real-time  operation, 
it  takes  charge  of  the  time  when  data  transmission  occurs  in 
a control  loop.  The  remote  computer,  once  receiving  a notice 
for  data  transmission,  must  respond  promptly. 

To  take  care  of  this  situation,  the  procedures  in  the 
host  computer  and  the  remote  computer  are  integrated  with  some 
degree  of  parallel-processing  ability.  The  procedure  in  the 
remote  computer  is  designed  with  an  interrupt-driven  function 
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by  the  input  of  the  serial  port.  Thus,  when  it  receives  a 
notice  for  data  transmission,  the  assigned  data  are 
transmitted.  When  there  is  no  request  for  data  transmission, 
the  remote  computer  displays  and  updates  the  information 
according  to  keyboard  instructions.  With  this  asynchronous 
communication,  the  sending  process  of  the  remote  computer  does 
not  have  to  suspend  in  order  to  wait  for  the  acknowledgment 
signal  from  the  receiving  process  of  the  host  computer. 

In  this  experiment,  the  remote  computer  can  issue 
artificial  torques  to  the  robotic  joystick  subsystem.  An 
artificial  force  in  the  Z-direction  is  applied  to  the  system 
to  demonstrate  the  force  reflection.  Its  level  can  be 
increased  with  the  "t"  key  or  decreased  by  the  "I"  key.  Other 
keys  on  the  remote  computer  turn  on/off  the  force  reflection. 
When  the  operator  grasps  the  handgrip  of  the  PRJS,  wrenches 
are  reflected  to  the  operator's  hand.  If  the  operator  does 
not  overcome  them,  the  PRJS  will  push  along  corresponding 
directions  with  small  displacements. 

A more  flexible  program  is  also  coded  in  the  remote 
computer.  It  allows  the  operator  to  control  the  levels  of 
reflecting  torques  for  each  of  the  six  joints.  The  key 
commands  are  listed  as  followings: 

t — to  increase  the  torque  level, 
i — to  decrease  the  torque  level, 

■+  — move  to  modify  the  next  joint  torque, 
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«-  — move  to  modify  the  previous  joint  torque,  and 
other  keys  — to  turn  on/off  the  force  reflection. 

The  experimental  system  can  reflect  the  remotely  artificial 
torques.  System  response  is  stable  and  smooth. 

4 . 5 Milestones  for  Achieving  Experimental  Results 

In  robotics  research,  data  communications  and  system 
integration  have  been  ignored  topics  although  they  are 
necessary  components  to  a complete  system.  Recently,  Brady 
reviewed  "robotics  science"  and  recognized  system  integration 
as  an  open  problem  [56].  These  topics  are  occasionally 
studied  in  theory;  though  a practical  solution  is  still 
required.  Ignoring  these  topics  is  often  reflected  by  a 
degradation  of  system  performance.  To  obtain  good  performance 
with  integrated  systems,  the  integration  must  be  managed  with 
an  engineering  concept  of  global  optimization.  All 
computations  and  data  communications  must  be  taken  into 
consideration  and  must  be  the  most  effective  configuration 
within  the  economical  conditions.  In  order  to  have  a grasp 
on  every  piece  of  a system,  off-the-shelf  softwares  are  not 
appropriate  since  they  carry  too  much  system  overhead  and 
"dark  corners"  which  could  trap  end  users. 

In  integrating  the  PRJS  system,  data  communications, 
interface  compatibility,  and  the  requirement  of  real-time 
operation  are  significant  problems  encountered. 
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Reliable  networking  with  high  communication  speed  should 
be  adopted  for  data  communications  if  it  is  available. 
Parallel  interface  is  superior  to  serial  interface  as  far  as 
communication  speed  is  concerned.  To  determine  the 
transmitted  data  between  systems,  a specific  format  regarding 
both  data  type  and  data  block  must  be  chosen.  The  thought  of 
reserving  the  transmitted  data  space  for  later  usage  is  often 
too  generous  to  be  tolerated.  As  long  as  a byte  (8  bits)  is 
sufficient  to  cover  the  range  of  data,  a 2-byte  data  type  is 
wasteful . 

In  the  PRJS , instead  of  using  a serial  port  of  the  PUMA 
controller,  a parallel  connection  is  made  between  the  TANDY 
computer  and  the  AIB  of  the  PUMA  controller.  Another  parallel 
interface  is  used  to  read  the  sensed  wrenches  from  FT-15/50 
so  that  not  only  the  highest  sampling  rate  of  the  force/torque 
sensor  but  also  the  shortest  transmitting  time  of  the  wrench 
data  is  obtained.  The  communication  software  is  coded 
specifically  for  these  purposes  and  a tight  communication  is 
implemented  between  the  host  computer  and  the  PUMA  robot 
system.  Limited  by  the  existing  facilities,  a serial  line  is 
used  to  connect  the  host  computer  and  the  remote  computer. 
The  deficiency  is  partially  overcome  by  programming  the 
control  chip  (NS  16450)  for  the  serial  port  inside  the  TANDY 
computer.  The  communication  speed  of  38600  baud  is  thus 
reached,  which  is  four  times  higher  than  common  serial 
communication  speed.  To  demonstrate  the  feasibility  of  the 
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reflecting  forces  from  a remote  system  to  the  PRJS,  joint- 
torque  information  is  transmitted  from  a remote  computer  to 
the  host  computer  in  a one-byte  format  for  each  DOF . An 
interrupt  programming  technique  is  applied  to  make  the  two 
computer  systems  work  nearly  independently.  The  arrangement 
of  the  minimum  communication  time  makes  this  simulated 
bilateral  system  operate  transparently. 

Accessibility  to  the  system  hardware  is  an  important 
feature  for  personal  computers,  which  is  normally  not  allowed 
with  mainframe  systems.  The  performance  of  integrated  systems 
can  thus  be  improved.  The  only  hurdle  with  hardware- 
programming techniques  is  that  they  are  system-dependent  and 
most  of  these  technique  details  are  not  mentioned  in  manuals. 
BIOS  function  calls  and  DOS  function  calls  are  listed  in  the 
technique  manual  without  specific  details.  Extensive 
experimentation  is  required  in  order  to  take  advantage  of  the 
computer  system  hardware.  In  controlling  the  PUMA  robot,  the 
computer  is  required  to  track  the  28  msec  cycle  time.  The 
address  of  system  timers  can  be  directly  accessed,  but  they 
count  only  up  to  a power  of  two  multiplied  by  1.935125 
milliseconds,  which  is  not  suitable  for  the  application  of  the 
PRJS.  The  BIOS  interrupt,  15H,  with  registers  AH  = 85H,  AL 
= 0,  DX  = 1,  can  be  used  for  this  purpose.  This  function  call 
offers  the  ability  to  count  milliseconds  as  a background  task. 
Therefore,  no  extra  CPU  load  is  added  in  executing  the 
programming  codes.  A puzzle  about  the  usage  of  this  BIOS 
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timer  function  was  encountered.  It  apparently  could  be 
trigged  by  some  tasks  in  the  computer  system  and  never  be 
turned  off.  Under  such  circumstances,  the  BIOS  function  did 
not  work  properly.  This  was  remedied  by  resetting  the  timer 
in  order  to  assure  the  BIOS  call  serves  its  function. 

Another  difficulty  in  the  PRJS  is  the  compatibility  of 
interfaces.  The  parallel  interface,  PC-11,  is  the  only  known 
hardware  which  "emulates"  the  DRV-11  parallel  interface  for 
the  PC-bus.  It  is  important  to  realize  that  the  8-bit  PC-bus 
PC-11  is  designed  to  emulate  the  16-bit  Q-bus  DRV-11  parallel 
interface.  In  order  to  assure  the  interfaces  are  compatible 
up  to  the  functional  needs,  experiments  are  necessary  to 
confirm  the  exact  results.  This  is  important  in  building  the 
operator's  confidence  before  grasping  the  endgrip  of  the  PUMA 
robot  as  a joystick  device.  Experimental  results  showed  that 
a dummy  variable  must  be  sent  to  the  DROUTH  register  to  ensure 
against  a data  overrun  problem  with  the  PC-11  interface. 
Unexpected  motion  of  the  PUMA  robot  may  occur  if  the  DROUTH 
register  does  not  receive  a variable  every  executing  cycle. 

Real-time  operation  requires  all  the  computations  to  be 
finished  in  less  than  28  milliseconds.  The  computation  codes 
must  be  arranged  without  any  redundant  operations.  The 
control  algorithm  must  also  be  simple  enough  to  implement. 
The  existing  facilities  in  the  laboratory  make  it  difficult 
for  a real-time  system  to  log  data  without  disturbing  system 
performance. 
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Another  caution  about  feedback  control  is  that  the  loop 
must  be  closed  in  a very  tight  fashion.  Computations  should 
be  executed  outside  the  feedback  loop  as  much  as  possible. 
Otherwise,  joints  could  travel  some  distances  before  the 
feedback  signals  are  summed  to  the  input  commands  and  thus 
extra  errors  are  created. 


CHAPTER  5 

CONCLUSIONS  AND  RECOMMENDATIONS 
5 . 1 Concluding  Remarks 

The  experiment  has  successfully  demonstrated  the 
feasibility  of  utilizing  an  industrial  robot  as  a joystick 
controller.  This  success  is  no  miracle.  By  inspecting  the 
technology  of  the  design  of  robotic  systems,  we  can  recognize 
that  the  design  of  a joystick  controller  and  that  of  a robot 
system  share  the  same  technological  foundation.  It  is  also 
important  to  notice  that  the  approach  in  this  project  can  be 
readily  implemented  on  any  existing  industrial  robot  by 
enhancing  the  system  with  an  extra  force-detecting  sensor,  for 
example  a force/torque  sensor.  Reliability  and  stability  of 
the  additional  sensor  are  important. 

In  the  case  of  robotic  systems,  compromises  between 
important  performance  parameters  such  as  payload  and  the 
maximum  velocity  are  normally  made.  Payload  for  a joystick 
controller  is  not  significant  because  it  is  undesirable  to 
impress  large  forces  on  an  operator  (especially  for  long 
periods  of  time) . Therefore,  a wider  performing  range  may  be 
adopted  in  designing  a joystick  controller. 
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In  attempting  to  use  an  existing  robot  system  as  a 
joystick,  it  is  good  to  know  the  advantages  and  disadvantages 
associated  with  this  idea.  The  slave  manipulator  system  and 
communication  systems  are  assumed  to  be  modular  so  that  the 
comparison  can  be  made  on  the  same  basis.  Under  such 
circumstances,  a robotic  joystick  subsystem  contains  merits 
such  as: 

• The  design  process  is  essentially  no  longer  required. 

• It  can  provide  a testbed  for  different  types  of  joysticks 
as  long  as  those  types  of  robots  exist. 

• There  is  no  need  to  be  bothered  about  the  use  of  analog- 
to-digital  converters  in  a robotic  joystick  subsystem 
since  they  are  already  built  into  the  controller  of  the 
robot  system. 

• A robotic  joystick  system  is  more  flexible  in  the  sense 
that  system  parameters,  such  as  damping,  stiffness,  and 
gain,  are  programmable.  On  the  contrary,  a designed 
mechanical  device  always  comes  with  specific  (though  not 
necessarily  well  known)  mechanical  properties. 

There  are  also  some  demerits  that  come  along  with  this 
approach.  Comparing  with  a designed  joystick  controller,  a 
robotic  joystick  subsystem  needs  the  computer  system  to  carry, 
in  some  respects,  an  extra  burden;  for  instance,  the  I/O  to 
an  interface  for  the  force/torque  sensor  in  this  project  is 
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not  normally  utilized  in  a robot  system.  Extra  computations 
of  the  Jacobian  matrix  and  its  coordinate  transformations  are 
also  not  common  in  an  industrial  robotic  system. 

To  use  an  industrial  robot  as  a joystick,  there  are  some 
issues  with  no  clear-cut  answer  to  say  whether  they  are  good 
or  not.  For  example,  when  the  servo  of  the  factory-supplied 
system  is  adopted,  no  work  is  required  in  order  to  tune  the 
servo  gains.  The  responses  of  the  servos  are,  however, 

limited  by  the  factory  design. 

Besides  all  these  comparisons,  the  PRJS  does  show  the 
capability  of  being  used  as  a joystick  regardless  of  its 
physical  dimensions. 

5 . 2 Recommendations  and  Future  Work 
The  main  goal  of  this  project  is  not  to  rule  out  the 
contribution  of  research  on  the  design  of  teleoperation 
controllers.  We  hope  to  make  more  effective  and  more 

profitable  use  of  the  existing  knowledge  and  technologies. 

One  may  wonder  who  will  pay  for  a joystick  controller  at 
the  cost  of  a robot  system.  However,  joystick  controllers 
for  the  bilateral  system  do  carry  the  same  components  as  the 
robots.  The  expense  of  the  bilateral  controller  can  be 
reduced  only  if  coarse  resolution  potentiometers  are  used, 
instead  of  the  fine  resolution  encoders.  Besides,  the  robot 
manufacturers  must  recognize  the  diverse  applications  of  their 
technologies . 
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Based  on  the  experiences  of  this  project,  it  is  believed 
that  several  actions  can  be  taken  to  improve  the  performance 
of  a robotic  joystick  subsystem. 

An  overall  review  of  the  existing  industrial  robots  is 
helpful  in  that  a better  candidate  for  a specific  purpose  can 
be  made.  The  operating  volume  of  the  robot  is  one  thing  to 
be  concerned  about.  A good  joystick  should  comply  with  the 
workspace  of  a human  being.  The  sampling  rate  is  another 
crucial  factor  for  the  robotic  joystick  subsystem.  A faster 
sampling  rate  can  make  the  system  work  closer  to  a continuous- 
time system,  and  time  delay  in  the  response  of  joint  motions 
can  be  reduced.  This  concept  can  be  analogously  regarded  as 
a mechanical  system  with  less  backlash. 

It  is  obvious  that  there  is  more  than  one  method  to 
convert  the  industrial  robot  to  a joystick,  depending  upon  the 
available  facilities.  As  far  as  the  enhanced  sensor  is 
concerned,  force/torque  sensors  can  be  alternatively  put  on 
the  joint  axis  (the  so-called  colocated  sensor)  so  that  a 
larger  bandwidth  of  a stable  dynamic  range  is  obtained  and 
bigger  control  gains  can  be  used.  If  a suitable  non-attached 
sensor  to  the  robot  is  integrated  into  the  system,  none  of  the 
stability  of  dynamics  response  will  have  been  affected. 

An  appropriate  design  of  the  computer  architecture  can 
make  the  whole  system  perform  well.  A tightly  coupled 
distributed  computer  system  is  mandatory  for  a good 
teleoperator  system.  Although  the  concept  of  networking 
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offers  high-speed  data  communication,  experience  did  not  show 
it  to  be  beneficial  all  the  time.  It  is  better  if  a shared- 
memory  architecture  exists  in  the  system  so  that  no  delay  of 
data  distribution  takes  place  between  processes.  An  operating 
system  with  multitasking  capability  can  be  helpful  in  robot 
control  if  system  overhead  can  be  avoided. 

Safety  has  been  an  important  consideration  by  the  users 
of  robots.  In  a robotic  joystick  subsystem,  suitable  safety 
measurements  must  be  adopted.  This  is  especially  true  for  a 
force-reflecting  joystick. 

An  additional  benefit  of  this  project  is  to  open  the  view 
of  the  robot  manufacturers.  Owing  to  the  similarity  between 
the  robot  and  the  joystick,  the  manufacturers  could  extend 
their  own  technologies  to  joystick  design  and  production. 
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